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ABSTRACT 


The theory, detailed outline of operating and 
algorithm procedures of a continuous time-invariant, 
linear control state variable systems design and 


analysis computer program is presented. The progran, 
SVS, which is based on Melsa’s LINCON, was modified to 
eemoensGtrate Controllability, Observability, Bode Plot, 
ROOt locus plot, Nyquist BLOU, pole placement, 
huenbermeer observer design, optimal control design, 
time response plot and some basic matrix manipulations. 
Worked examples with the program output are included. 
Some options give only numeric data output; others give 
both numeric data and high-resolution graphs. The 
software, which is fully interactive, menu driven and 
user friendly is written in Turbo Pascal to be run on 
the IBM-PC microcomputers. All options are presented 
via option menus and the user will be prompted for all 
input parameters. 
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I. LINEAR CONTROL STATE VARIABLE SYSTEMS 
(SVS) 


A. INTRODUCTION TO THE SVS 

SVS is software for the IBM-PC microcomputer in 
the analysis and design of continuous time, linear 
control systems. These programs are based on the matrix 
mathematics of state variables and were first developed 
by Melsa [Ref. 1] and adapted for batch use at NPS by 
Desjardins [Ref. 2]. 

The original intent of this thesis was simply to 
take Desjardins’ adapted version of Melsa’s LINCON and 
modify it for the Turbo Pascal computer language. The 
features of this thesis are: 

- User-friendly as possible 
- Menu-driven program. <Q>quit key always returns to 
the SVS main menu. 

The hierarchical menu Structure is three levels 
deep at any point. So the user, before selecting 
his/her option, can get help at every menu. 

SVS was tested with several examples and is now 
available to any user on the Naval PostGraduate School 
control laboratory PC’s under the SVS directory name. 


B. SYSTEM REQUIREMENTS 

SVS is a large program and requires at least 512KB 
of Memory to run. The program will run on any IBM-PC or 
compatible "MS-DOS" computer and requires a standard 
IBM color Graphics Adapter (CGA) or IBM Enhanced 
Graphics Adapter (EGA) card. It will run _ on either 
monochrome or color Smoenitor, but all menus”) are 
Supported by color, for that reason they are easier to 
work with a color monitor if available. The graphics in 
the program are in high resolution (64@ X 200) mode. 
They only appear in the white-on-black. The graphics 
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can be dumped to an EPSON, IBM-Graphics, or compatible 
Prawcer by Using the Shift + PrtSc key. 


The program is written in the Turbo Pascal 
Language. Turbo Pascal has a 64K data segment and code 
sives limitation. Under this restriction, SVS is 


compiled as five executable programs and nineteen 
"Chain" files. The main program name is SVS in the disk 
files. It has extension .COM. The chain files have 


extension .CHN and they are not themselves executable. 


C. FILES ON THE DISK 


A complete testi. Of the files and ae brief 
description of these are below. 


(1) SVS.COM 
o2)) INPUT .COM 
(3) MATRIX.COM 
(4) PLOT.COM 
(5) CHANGE.CHN 


{ The executable main menu module } 
{ The input/change menu module } 
{ The matrix mathematics menu module} 
{ The graphics menu module } 
{ Allows user to change input data 
{ values} 
(6) POLYNOM.CHN { Calculates characteristic 
{ polynomial of A matrix  )} 
oye GolleRol-CHN { Calculates controllability of the 
{ system )} 
(8)DETERMIN.CHN { Calculates determinant of the A 
{ matrix } 
(9) EIGEN.CHN { 
(10)BODE.CHN { Gives Bode plot of the system } 
(11)TIMEPLOT.CHN{ Gives time response of the system} 
(12)OBSER.CHN { Calculates observability of the 
{ system) 
(13)LUENBERG.CHN{ Design Luenberger observer to 
{ achieve a closed-loop poles of the 


Shows eigenvalues of the A matrix } 


{ system } 
(14)OPTIMAL.CHN { Optimal control design program } 


(15)POLE.COM To calculate feedback coefficients 
to achieve a desired closed-loop 
poles } 

(16)SAVE.CHN 
(17)RETRIEVE.CHN 


(18) INVERSE .CHN 


Saves data to desired drive )} 
Gets data from desired drive } 
To calculate inverse of the A 
matrix } 

(19) INPUTDAT.CHN To permit user to enter the input 
data for whole system  } 
(20)HELP1.CHN Help program for SVS main menu 
options} 

(21 )HELP2.CHN Help information for the 
input/change menu options  } 
(22 )HELP3.CHN Help information for the matrix 
mathematics menu option  } 

(23 )HELP4.CHN Help information for graphics menu 
option  } 

(24 )NYQUIST.CHN to calculate Nyquist (polar) plot 
of the system } 

(25 )RLOCI .CHN 


(26 )ROOTS.CHN 


Root locus plotting procedure} 


Shows plant characteristic 
equation roots 


mmm rm NNO OS OS OS OS 


In addition to these files, there are three 
"system" files that are needed to run the program. 
These are 4X6.FON, 8X8.FON and ERROR.MSG files. 


D. STARTING TO THE SVS 

This software package has two diskettes. The first 
step is to get the SVS main menu on your’ screen. All 
you have to do is follow these steps: 


1. Turn on the power ( or, if it’s already on, the 


user reboots the computer ). 
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euewarmt for the operating system prompt. It will 
look like one of the following: 
Cr 
o>. 
C\>_ 
ee 
el 
COy> 
(or some other letter). 
The prompt may look somewhat different, depending 
on the computer and how it has been set up. 

3. Type MD SVS and press <ENTER> key. This opens a 
new directory. 

4. Type CD\SVS and press <ENTER> key. This enters 
Wee wew Girectcory. 

5. Insert disk #1 into disk driver A: 
Type Copy A:*.* and press <ENTERD key. 

6. Repeat step 5 for disk #2. 

7. Type SVS and press <ENTER>D key. 


Now the user is in the SVS main menu and ready to 
work. Make a choice for further step. 
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II. INPUT/CHANGE MENU 


A. INTRODUCTION TO THE INPUT/CHANGE MENU 

The first step, of course, is to enter the A, B and 
C matrices into the computer as aocommon input. This 
is the starting point of the program. For our case, 
the general state variable equations are represented by 
the following equations. 


eet} = A RCE} $B Bly} (323} 
where A, B, C are given matrices and D is assumed to 


have a zero elements for this progran. 


*** SVS MAIN MENU *** 


(I) Input/Change Plant Matrices Menu 


(G) Graphics Menu 

(C)> Control] labw iat 

(O) Observability 

(L) Luenberger Observer Design 
(D) Design of Optimal Control 
(P) Pole Placement 


(M) Matrix Mathematics Menu 


(H) Help 
(Q) Quit the Program 


Make Your ee Poco 
Naval Postgraduate School Ismail UNLU 





Figure 2.1 The SVS main menu. 
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From the opening menu of SVS, shown in Figure 2.1, 
we choose the "Input/Change Plant Matrices Menu" 


option to bring us to the Input/Change menu shown in 
Preure 2.2. 


“x INPUT / CHANGE MENU *** 


(I) Input Plant Matrices 
(C) Change Current Plant Matrices 









(S) Save Plant Matrices to Disk File 
(L) Load Plant Matrices From Disk File 










(H) Help 
(Q) Quit to SVS Main Menu 







Make Your Selection 


Figure 2.2 The input/change menu. 


This input/change menu allows the user’ to enter 
common inputs to all programs. These common inputs are 
the plant or A matrix, the input or B matrix and the 
Gepput or CC matrix. The only restriction is the 
dimensions of the matrix. It must be no greater than 
10. This means that the maximum matrix size has to be 


10X10. However, due to a user decision, a dimension 
size not to exceed 6 is required. The reasoning behind 
higscewas Gue, in part, to the printer. since wae 


Cupp format to the printer is B11, this naturally 
limits us to 6 numbers per line. [2 format places are 
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normally considered necessary for good accuracy. HO 
systems with order greater than 6, every row of the 


matrix is continued on the second line. After 
attempting this, it was decided the results were 
dificeult-to read: Otherwise it is appropriate up toa 


10th order system. 


B. INPUT PLANT MATRICES 

This option is used to initially enter the A, B and 
C matrices of the state variable equations (2-1) and 
(2-2). For this option, select the “Input plant 
matrices" from the input/change menu. The screen will 
prompt the degree of the plant, which is the dimension 
of the A matrix. The maximum acceptable degree is 1@. 
Then it asks for elements of the A matrix and so forth. 

Matrices are entered one element at a time 
beginning with 1,1 and continuing across the row of the 
Matrix. The next row is then entered, and the process 
continues until all elements have been entered. After 
the matrix is entered, the complete matrix is 
automatically brought to the screen for review and 
possible element changes. If a change to the matrix is 
desired the user simply enters the row and column 
number to change after every prompt. Then the program 
asks for corresponding matrix elements to change. 
After being prompted, the change is entered. A review 
of the matrix is again brought to the screen. The user 
is again prompted for any more possible changes. This 
procedure continues until all changes have been done. 
The same A matrix procedures are repeated for the B and 
C7 matrices:. This input data can be used for the 
options without saving to disk file until quitting the 
program. 
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C. CHANGE CURRENT PLANT MATRICES 

This option allows the user to change input data A, 
Beomwaec Matrices quickly and easily. The user can 
change the order and elements of the matrices that were 
previously entered. as powerful combination 
facilitates both inp Ut GORnRGect lon and changes, 
especially for higher order matrices during the design 
process. First Figure 2.3 appears on the screen. The 
User can choose one matrix at atime for correction. 
Then the program gives the order and elements of the 
selected matrix. In the beginning the user can enter a 


¥** Change Current Plant Matrices Procedure *** 


Which matrix do you want to change ? PLANT (A) A_ 
PPT (CB) 
CULPUL. CC) 


Press <ESC> to change it!, 


Then input your choice with <BENTER> key 





Figure 2.3 Change current plant matrices selection. 


correction to the order of the matrix. Then, under the 
new dimension, can make corrections on elements of the 
matrix. The program shows the corrected results on the 
screen. At the end of the progran, the user 
automatically returns to the input/change menu. If the 


user wants to change more than one matrix, he/she must 
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choose the "Change Current Plant Matrices" option two 
or more times. A basic example for this option is 
illustrated in Figure 2.4. 


D. SAVE CURRENT MATRICES TO DISK FILE 

This procedure is used to store plant matrices to 
the hard disk or floppy disk file. First 2eeproner. 
drive C as a saving drive. Then asks the user for the 
drive designator (A through E), and filename for the 
problem to be saved. Bight characters of a MS-DOS 
filename are allowed; the program gives a filename 
extension of ".SVS" to each data. This extension is 
used to limit the disk search for appropriate files. A 
drive and filename are supplied by the program, which 
opens the file and stores the data. The procedure 
stores the data as a text file. A text file consists 
of ASCII characters, and is usually designed to hold 
readable information [Ref. 3]. 


E. LOAD PLANT MATRICES FROM DISK FILE 

The procedure first asks the data drive where the 
problems are stored. After this is done, the program 
calls another procedure called "Directory" [Ref. 4]. 
This procedure uses MS-DOS function, calls and shows 
all available data files on the screen. The user can 
choose one of the files by moving arrow keys with 
<RETURN> key. Then the program opens the file and 
reads it. 

The directory displays only the disk files with the 
extension ".SVS". This eliminates the possibility to 
read other files. 
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The A matrix is 


Change ? (Y/N) 


<f 
” 
a 
qi 
vy) 
re) 
”) 
b> 
” 
0) 
G 
pp 
GH 
O 
hy 
0) 
ga 
f, 
O 
oO 
G 
EH 


The order of the system is:3 


The A Matrix is 


Do you want to change any element ? (Y/N) 


Input row to change 


1 


® 
® 


imeut column to change 


Rae A Matrix is 


Do you want to change any element ? (Y/N) 





Change current plant matrices example. 


Figure 2.4 


Te 


III. GRAPHICS MENU 


A. INTRODUCTION TO THE GRAPHICS MENU 


From the opening menu of SVS, shown in Figure 2.1, 


we choose the " Graphics Menu " option to bring us the 
Graphics menu shown in Figure 3.1. The Graphics menu 
contains five basic options. These are the time 
response lot , Nyquist pPlLOGs Root” Vlocuss plone 
characteristic equation roots and Bode plot. This menu 
is also supported with the "Load plant matrices from 
disk file” option. This selection allows the user to 


get data from the disk file quickly instead of going 
via the SVS main menu route. 


*** GRAPHICS MENU *** 


(L) Load Plant Matrices From disk File 


(C) Characteristic Equation Roots 
(B) Bode Plot 

(N) Nyquist Plot 

(T) Time Response Plot 


(R) Root Locus Plot 


(H) Help 
(Q) Quit to SVS Main Menu 


Make Your Selection 





Figure 3.1 The graphics menu. 


B. BODE PLOT 


Bode plot analysis can be accomplished with the 
Graphics menu by selecting the <B> Bode plot option. 
This selection brings Figure 3.2 to the screen. There 
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are two selections f10Fr the frequency plot: the 
open-loop Bode plot and closed-loop Bode plot. Input 
data for this option is entered with the Input/change 
plant matrices menu selection which is explained in 
Chapter II. If the user wants the closed-loop Bode 
pot, the program automatically calculates for the 
negative unity-feedback condition. 


*** Bode Plotting Parameters *** 


Open (0) or Closed (C) Loop Plot? 


at is the first 
Example: .@1, 1 


frequency to be lotted? 
100, acer 5 = 


How many decades do you want plotted? 





Pigure 3.2 Bode plot parameters selection. 


The user also must enter the starting frequency and 
number of decades for the plotting. Lone upp er 
frequency limit is calculated based on the number of 
decades. That is, if user selects .1 as the starting 
frequency with 4 decades, then the upper frequency will 
be 10@@ rad/sec. 

Bode plot displays two plots at the same time. 
These are plots of magnitude and phase versus radian 
frequency. Magnitude is converted to the decibels unit 
Using the relation 

Magnitudegp = 28 log;g(magnitude ) 
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and phase is converted to degrees using the relation 
PhaS€degree = (188/77) Phase 


Magnitude calculations for the single pole or zero can 
Des wrictenaas 


Magnitude = [Realpart? + (w-Imaginarypart)@ 11/2 
and the phase calculation is 
Phase = Tan~![{(w-Imaginarypart)/Realpart]. 


For the whole system, the magnitude and phase are 
calculated for each pole or Zero. Then the final 
magnitude is 


Magnitudéesystem = Magnitudegeros/Magnitudenoles 


and the phase is 


Phas€system = Phase€zgeros - PHAaSe€poles 


The plots of the magnitude and phase are shown on the 
same graph. Coordinate values of @dB magnitude and 
-180° phase coincide in the graph. We know from 
control theory that phase margin is read at the zero 
crossover of the magnitude curve and the gain margin is 
read at the -18@0° crossover of the phase curve. These 
two values can be read directly from the graph. The 
Bode routine calculates the numbers required for the 
plots. The procedure "plot-Bode" converts the number 
to a graphical display. Within the Bode-plot routine 
is a call to the procedure "graph-menu". Graph-menu is 
Called by all procedures which produce a graph. EG 


provides a small menu offering the user the choice to 
add a title to the graph, print the graph on the 
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premcer;, print the number or quit and return to the 
menu. 

ff the@™user seeets ~the title to graph and it is 
completed, the plot is displayed with the title on the 
screen. The title block can be moved by using the 
cursor arrow keys and relocated anywhere on the screen. 
When the title box is moved where the user wants, the 
<enter> key must be pressed. Then the screen is frozen 
in position and the graph menu is recalled on the 
screen. 

The print numbers’ selection saves the current 
fraphic screen and permits the user to print the 
numbers used to draw the graph. The numbers may be 
printed on the printer (this will use a lot of paper) 
or to a disk file. If the disk option is selected, the 
user can scan that file with aword processor or by 
using the DOS "type" command and examine the points of 
interest. This option is illustrated on example 3.1. 


EXAMPLE 3.1 


The example can be stated as follows: Given plant 
transfer function 


100 ( @.02 S + 1) 


‘s)- (s +1)( .1s +1) ¢.01 s + 1)? 


-® 


was rearranged as a state variable equations. 


? @ 1 Q @ Q 
x(t)= Q Q 1 Q x(t) + Q Lt) 

Q Q Q 1 Q 

-10@0@0 -11200@ -1221@0 -211 1 


y(t) = | 19900000 200000 2 | x(t) 


2a 


a) Obtain the Bode diagram of the above system. 
b) Mark the following on the Bode diagram, recording 
the numerical values. 
1) Gain crossover frequency 
2) Phase margin 
3) Phase crossover frequency 
4) Gain margin 
5) Resonant frequency. 


[SOlLUT fem: 

Given data entered to the program by the selecting 
of the Vin pie Plant Matrices" option “ame tie 
input /Change menu. Then the program outputs can be 


seen from the Figure 35.3 and Figure 3.4. 


4 
A ie. 
5 
H 
I 
T 
U 
D 
E 
J... 
E 


Bagusontcase +3 


dD 
FREQUENCY ae@sen 





Figure 353.3 Open loop Bode plot for example 5.1. 
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Figure 53.4 Closed loop Bode plot for example 3.1. 


C. TIME RESPONSE PLOT 

It is desirable to see the system’s response in the 
time-domain to a typical input. Time response can be 
calculated and plotted with the SVS program as can the 
Ssotem input sinusoid, ramp, step or impulse. All 
these inputs have user selectable amplitudes. Figure 
3.5 shows the time response parameter screen. 

The time response algorithm first converts the A, B 
ange c Matrices to the open loop transfer function, then 
into a discrete-time, state-space equivalent. The 
MiceryeOr the time response plot is not included here. 
tiaepamewie Want more information about the subject 
should consult reference 4, or any other relevant 
textbooks. 


EXAMPLE 3.2 
For the given system in example 3.1, obtain the 
time response plot and mark the following on the time 


response plot, recording the numerical values. 


a 


1) Settling time 


2) Maximum overshoot for a step input. 


30) Wd ben,:: 
The program data has already entered for the Bode 
DEOte The selecting "Time response Plot" in the 


graphics menu gives figure 3.6 as a problem solution. 


¥*x* Time Response Plotting Parameters *** 


What is your input to the system? STEP 
RAMP 

SINE WAVE 

IMPULSE 


What is your input amplitude? 


Input one of these choices, Open (0) or Closed (C) C 


Input your simulation time to the system (99max) 1.4 





Figure 3.5 Time response parameters screen. 


D. NYQUIST PLOT 

This section presents the Nyquist plot option. 
This selection gives open loop and unity-feedback 
closed loop Nyquist plot. The program first calculates 
open loop transfer function of the plant. Then the 
plot is obtained by calculating "the mMagnitudes and 
phases angle of the transfer function for a specified 
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Figure 3.6 Time response plot for example 3.2. 


number of times with a specified increment of w. 
Before proceeding to the Nyquist plot, the program 
prompts the menu of Figure 3.7. This parameters screen 
allows the user to enter additional data for the 
Pletting . The graphic window size is given 100X100 
scale if the user selects the big picture option. The 
select own size option asks the user to enter starting 
frequency, number of decades and X,Y coordinates 
maximum and minimum values for the plot. After getting 
the plot, the procedures are the same as with the Bode 
Belen OptLOn. These are make a title to the graph, 
printer output and listing numbers (which are used to 
generate a graph) either to the printer or a specified 
file with a given drive name. 


a 


“** Nyquist Plotting Parameters *** 


Open (0) or (C) Closed loop plot? O 
Graph window (B) or (S) Select your own size? S 


Inpus our first frequency to be lotted? 1 
(Example: .O1 Sa 130. Boia : = 


Input number of decades do you want plotted? 


X-Maximum 100 
X-Minimum -100 
Y-Maximum 100 


Y-Minimum -100 
Any changes to these parameters? ( Y / N ) 


Press <F1> to change previous entry 





Figure 3.7 Parameters selection for the Nyquist plot. 
EXAMPLE 3.3 


Figure 3.8 shows the Nyquist plot for the example 
5.1 A, B and C matrices. 


am (Ue ee 
THESIS ERMNPLE 





Figure 3.8 Example of the Nyquist plow. 
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E. ROOT LOCUS PLOT 

This option plots the loci of the closed loop poles 
of a system with transfer function G(s) = K N(s)/D(s) 
for varying gain. N(s) and D(s) are polynomials of the 
plant and the program calculates from the given A, B 
and C matrices. 

The user is prompted to enter the starting and 
ending gain values, maximum and minimum X,Y coordinate 
values and to select either positive or negative 
feedback. These plotting parameters are shown on 
Figure 3.9. After this input routine, the program 
assumes unity feedback and calculates root locations 
for varying gain and plots them. 


*** Root Locus Plotting Parameters *** 


Input STARTING value for the varying gain 


Input ENDING value for the varying gain 


X-Minimum -100 

X-Maximum 10@ 

Y-Minimum -10@ 

Y-Maximum 100 
Positive or Negative feedback? ( P / N ) 
Any changes to these parameters? N 





Figure 3.9 Parameters screen for the root locus. 


EXAMPLE 3.4 
Figure 3.10 shows the Root locus plot for the given 
data on the example 3.1. 


a4 





Figure 3.10 Example tern, thes cotetecuse eke c- 


F. CHARACTERISTIC EQUATION ROOTS 

This option of the graphics menu allows the user to 
decide whether the system is stable or unstable by 
looking at the root location of the characteristic 
equation. The program gives again the unity-feedback 
closed loop characteristic €quation reetseuet stcee> la 
The illustrative program output of the example 72 ie 
be seen in Figure 3.11. 


G. LOAD PLANT MATRICES FROM DISK FILE 
This last option of the graphics menu allows the 
user to get saved data from disk file directly instead 


of going via to the main menu and input/change menu. 
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¥*¥* Plant Characteristic Equation Roots *** 


ROOTS OF THE NUMERATOR 


s{1]J= -50.00 +j @.000 


ROOTS OF THE DENOMINATOR 


sCijJ= -132.032 +j @.@0@ s[2]= -69.170 +j @.00@ 


s[3]= -4.899 +j -32.893 s[4]J= -4.899 +j 32.899 





Figure 3.11 Example of characteristic equation 
roots. 


a 


IV. SVS MAIN MENU 


A. INTRODUCTION TO THE SVS MAIN MENU 

In this chapter six options are presented which may 
be used for the analysis and design of control systems. 
These options are supported by the other options which 
are explained in Chapter II and III. 

The observability option is used to determine the 
observability index of the system. Another very 
Similar program, controllability is used to determine 
the controllability of the system. The matrix 
mathematics option brings to the screen another menu 
selections. This program calculates an A matrix 
determinant, inverse, characteristic polynomial and 
eigenvalues. The last three options may be used to 
design optimal linear control systems. The pole 
placement option is useful in the design of linear 
control state variable feedback control systems. ler 
the pole placement case, the control is computed by 
multiplying by a gain [K], the difference between the 
reference input and a weighted (linear) sum of the 
State variables. The Luenberger observer design is 
used to design a combined observer-controller to 
achieve a given desired closed loop transfer functien 
when some of the states are not accessible. 

Design of optimal control will minimize a given 
cost function which preduces” a scalar control. The 
program starts to work at the terminal time and works 
backwards in time. 


B. CONTROLLABILITY 
This Option is used to determine the 
controllability of the linear time-invariant system. 


Consider the following continuous-time system 


3@ 


tee A xt) + Butt) (4-1) 
where 
= state vector 
Dan mat ri x 


= input matrix 


co} K 
i 


sPeonwurol “Snput 


The system described by the above equation is said 
to be state controllable at a given initial time if it 
Zo oOossmblc to construct an unconstrained control 
Signal which will transfer an initial state to any 
final state in a finite time interval [Ref. 5]. 

This requires an algebraic condition such that the 
momeer(C) of the controllability condition matrix 


Eo ee Bien Bil Gi=2) 


is n, the order of the system. 


EXAMPLE 4.1 
Consider the matrices A and B, 


Q 1 - 1 Q 
A = 1 Q : B= 0 1 
Q 1 a 0 @ 


Determine if [A, B] is a controllable pair. 


ome coh ooh 


Solution: Since A is 3x3 and B is 3x2, matrix C has to 
be 3x6. Ene program checked the rank of the 
controllability condition matrix. The result of the 
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program can be seen in Figure 4.1, the system is 
controllabie. 


CONTROLLABILITY RESULT 


QO. 
le 
Q. 


system is controllable. 





Figure 4.1 Controllability program output. 


C. OBSERVABILITY 

In this section we determine observability index of 
the linear systems. Consider the unforced system 
described by the following equations: 

The (unforced) time invariant system 


x = Ax (4-3) 
With the observation vector 
Cx (4-4) 


Jy 


The observability index, which is defined as the rank 
r(O) of the observability condition matrix 


CA 
O = ; (4-5) 


CANS! 


is n, the order of the system. 


D2 


The program Suto Uud for this selection is 
illustrated in Figure 4.2 with the A matrix as given on 
example 4.1 and the following C matrix. 


Gee 1s Gh ele) (4-6) 


OBSERVABILITY RESULT 


Output Matrix C is 
-O@O20900EK+00 GO.00000H+900 98. 00000EK+O00 


system is observable with index 3. 





Figure 4.2 Observability program output. 


D. POLE PLACEMENT 


Any single-input single-output linear, time 
invariant system is described by the following 
equations: 

x(t) = A x(t) + B u(t) (4-7) 
y(t) = C x(t) (4-8) 


The plant is characterized as a block diagram in 
Figure 4.3. 


oo 


ce 





Figure 4.3 Block diagram for the state variable 
representation. 


The closed loop nature of the system of Figure 4.4 
is showed by the presence of the controller. eG 
generates the control signal u from the knowledge of 
the state variables. So, we can see that, except for 
the reference input [r], the state of the plant x is 
the only information needed by the controller. The 





CONTROLLER 


Figure 4.4 General closed loop system with state 
variable feedback. 


34 


control input is computed by the multiplying by a gain 


K the difference between the reference input and a 
weighted (linear) sum of the state variables. Asa 
mathematical expression, 

wee [ nr — ( i eeeopet ...c 9+ Mex, 7) (4-9) 
where the Kk,’s are met Stel od. to as feedback 
Seerticients. The gain K is referred to as the 
controller gain. The equation (4-9) may be simplified 


by making it in the matrix notation 
u= K [fr - k! x ] (4-10) 


After all this notation, the graphical representation 
of the system configuration is shown in Figure 4.5. 





Figure 4.5 Linear state variable feedback system. 
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We could obtain the closed loop transfer function 
Y(s)/R(s) from the state variables. Our approach is to 
force the system into the contigurationgshnewn inveicume 
fOr 


r Uu 


KT x(s) 






Figure 4.6 Closed loop block diagram representation. 


We can see that Heg(s) is given by 


kl x(s) 


UE) (4-11) 


Heq(s)= 


Since y(s)= C x(s), this expression becomes 


KT x(s) 


Heq(s)= C x(s) 


(4-12) 


Here it must be pointed out that the program 


Calculates the gain K, so zero steady state error 
results from a step input. If the user wants other 
conditions, he may rescale K and kt appropriately by 
hand. For example, assume he wants to desire to have 


the controller gain, K=K,, but the program output shows 
that K=Kg with the feedback coefficients k,, Kop, Kz. 
The procedure is then to modify the program outputs by 
setting K=K, and setting 
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eT. —2 C ky ko kz J (4-13) 
Ky 

This procedure does not change Y(s)/R(s) and satisfies 
the condition K=K,. Under these notations and block 
diagrams, this option gives an open loop transfer 
function Y(s)/U(s) for the plant, the feedback transfer 
femetion Heq(s), the controller gain [K ] and the 
feedback coefficients [k!] to achieve the desired 

closed loop characteristic polynomial. 
The desired closed loop characteristic polynomial 
is the denominator of Y(s)/R(s) and must agree with the 


order of the plant. The user can enter this polynomial 
either in coefficient form or factored form. If the 
user wants to enter the coefficient forn, the 


coefficient of the highest degree term must be unity. 

The methodology for computing the result is: the 
coefficients of the denominator polynomial et 
Y(S)/R(s), which is the polynomial desired by the user, 
may be adjusted at will by proper selection of k and K. 
The closed loop Zeros are equal to the open loop Zeros. 
In other words, linear state variable feedback has no 
effect on the zeros of Y(s)/R(s). The program 
Calculates the numerator of Heq(s) to achieve the 
desired characteristic polynomial. Note that the 
complete Heq(s) is calculated by taking the numerator 
of Heq(s) and dividing decom t Day the numerator of 
Y(s)/U(s). In the program procedures, the coefficients 
of the characteristic polynomial are computed by the 
use of the Principle-Minor method. For the matrix 
inverse Ga loulatcaen, the program uses the 
GraceonaliZation procedures. 


EXAMPLE 4.1 
The plant matrices of a third order system are 
given in the following state variable representation: 


a 


-1.@ 1a) rn) 0 


x(t) = 0.0 0.@ Q xb mee Oya ) C4 
0.0 =30 0.0 
y(t) = [| SO eo 9.0 1 sce CA=aSe 


Find the feedforward (controller) gain [K] and the 
feedback coefficients [k!] required to achieve a closed 
loop transfer funcitwtenger 


Y(s) 2(s + 2) 
Ris) s+ 4s2+ sea 418) 


The program result for this example is presented in 
Figure 4.7. 


POLE PLACEMENT RESULT 
Plant matrix A is 
-9O2@O00E+00 1.00000E+00 9%0.00000E+00 
-9G@000E+00 9O0.00000E+00 1.00000H+00 
-9O@O0O00E+00 -3.0000E+00 9G0.00000E+00 
Input matrix Bis : 
.90000E+00 
.92@OOOE+00 
.90000E+00 


Output Matrix C is 
-O@0000E+00 1.Q00000E+00 @0.00000E+00 


Denominator of Y(s)/U(s) - Descending powers of S 
1.0000 1.0000 5.0000 43.0000 





Figure 4.7 Program output for the pole placement. 
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The poles of the Y(s)/U(s) are: 


REAL PART IMAGINARY PART 
-1.9000 +3 2.9200 
2.900@ +7 alee oro 
2.0000 +3 lees 
Numerator of Y(s)/U(s) - Descending powers of S 
1.9000 2.9000 
The zeros of the Y(s)/U(s) are: 
REAL PART IMAGINARY PART 
-2.00900 +3 0.9000 


Desired closed-loop Characteristic polynomial - 
Descending powers of S 
1.9000 4.90900 6.9000 4.90900 


The roots of desired closed-loop characteristic 
polynomial are: 


REAL PART IMAGINARY PART 
-2.0000 +3 0.9000 
-1.9200 As -1.0200 
-1.0000 ay 1.0000 
Numerator of the Heq(s) is - Descending powers of S 
1.5000 1.5000 0.5000 
The roots of the Heq(s) are 
REAL PART IMAGINARY PART 
-0.5000 +7 -0@.2887 
-0.5000 +5 0.2887 


The feedback coefficients [k!] are 
2.5000 2.9000 1.5000 
The gain [K] is : 2.0000 
Figure 4.7 Program output for the pole placement 
(continued ) 


The results shown in Figure 4.7 specify that the 
gain of the controller [K] is 2.@ and the feedback 
coefficients are k,=@0.5, Ko=@.@ and kz=1.5. 


OS 


E. LUENBERGER OBSERVER DESIGN 
Consider a linear time invariant plant of the form 


A x(t) + B u(t) (4-17) 
C x(a (4-18) 


x(t) 
y(t) 


Let a feedback control law for equations (4-17) and 
(4-18) will be 
u(t) = K [ r(t) - kt? x(t)J] (A= 








OBSERVER 





BZ) + Gy y teGo. Ui 


Figure 4.8 lLuenberger observer block diagram. 


Assume without loss of generality that the plant is 
controllable and observable. Since the state of 
equation (4-17) is not directly available to implement 
equation (4-19), an observer of the form 


z(t)= F z(t) + G, y(t) + Go u(t) (4-20) 


and replacing the true states with estimates yields 


u(t)= K [ r(t) - k? z(t)] Ch=2 
kiz(t)= h? z(t) + qt y(t) (A225 


Will be designed. The resulting closed loop system is 
shown in Figure 4.8. 


4@ 


Where 


to > NS Yq CX 


Gy 


Ms 

a 

2 
nN 


State vector 

COnurol input 

GutPuUTt 

system forcing input 

estimated state vector 

plant matrix 

mip uy Matrix 

observer eigenvalues matrix 
observer gain matrices 

controller gain 

OURMUTeteCeCdback “coefficients matrix 
observer feedback coefficients matrix 


Input degree of observer (190 max) 2 


Input the desired feedback coefficients in 


Factored <F> 
or Coefficient. <C> 


input observer characteristic polynomial 


Factored 
or Coefficient 


Peess <“BoC> to change it!, 


faen type your input with <BENTER> key 





Figure 4.9 Luenberger observer design parameters. 


The user has to enter the controller gain and the 


feedback coefficients which can be found by the use of 
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"pole placement” Spiewon. The program asks the observer 
elgcenvalues which are represented by the F matrix in 
the program. The observer degree depends on the 
observability index. For example, if the observability 
index r is the minimum integer, then the observer gain 
matrix [G] has oeuderwane Simply the order of the 
observer, when the program prompted can be entered, As 
equal to or greater than (r-1). These input parameters 
are shown in Figure 4.9. 


EXAMPLE 4.2 

The example presented here for the fourth degree 
plant is taken from Desjardin’s [Ref. 2]. The plant is 
represented by the following equations. 


y(t) = | WW) 20550530 ieee) (4-23) 
@ 1 @ @ @ 
: @ @ 1 @ 
x(t) = 5 5 x(t) + ' iit) (4-24) 
@ — | eee 1 


Solution: 


Step! 

The x; and xX are the only measurable states and we 
want to achieve following closed loop transfer 
Pune tone 

eas = a (4-25) 
R(s) st + 6s? + 17s" + 28s +20 


4.2 


The controller gain [ K ] and the feedback 
coefficients required are found, as can be seen from 
Figure 4.10 by the use of the "Pole placement" option 
in the same menu. Results shown in Figure 4.10 
indicates that the feedback coefficients [kl] are -3, 
-6, 15, 20 and the controller gain [K] equals unity. 


POLE PLACEMENT RESULT 


Ciuputematrix C is 
2.90000K+01 1.00000E+@Q1 ®@.@0000E+00 @.00000H+00 


Denominator of Y(s)/U(s) - Descending powers of S 
1.0000 9.0000 25.0000 15.0000 ®@.0000 

Numerator of Y(s)/U(s) - Descending powers of S 
20.0000 


Desired closed-loop Characteristic polynomial - 


Descending powers of 8S : 
1.0000 6.8000 17.@0@0@ 28.0000 20.0000 
Numerator of the Heq(s) is - Descending powers of S 
-53.@000 -6.9000 13.0000 20.0000 
The feedback coefficients [ k ] are 
20.0000 13.0000 -6.0000 -3.0000 
ime gaan { K | is : 1.0000 





Figure 4.1® Pole placement result for the Luenberger 
observer design. 
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ENE SO) 

The observability index is determined using the 
"Observability" option in the same menu. That results 
is shown in Figure 4.11. 


OBSERVABILITY RESULT 


system (A,C) is observable with index 3. 





Figure 4.11 Observability result for Luenberger. 


SLeoe 
As can be seen from Figure 4.12, the system is 
completely controllable. 


CONTROLLABILITY RESULT 


system (A,B) is controllable. 





Figure 4.12 Controllability output for lLuenberger. 
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Step4 

An observability index r=3 (result taken from 
observability output) allows us to design an observer 
of order equal to or greater than (r-1)=2. HOE. clic 


LUENBERGER OBSERVER RESULT 


Tne plant matrix Ais : 
@.O0O0OOE+00 1.00000E8+00 O8.00000E+00 80.00000E+00 
02.00000E+0@ Q2.@0000H+0@ 1.@2000E+00 @8.00000H+00 
@.Q0OOO@OK+0G0 O8.00000E+00 O.00000E+00 1.00000E+00 
2.90@0000E+00 -1.5000EH+01 -2.3000EH+01 -9.0000E+00 
miceanpuc Matrix Bis : 
®.2@0000E+00 
0.@00008+00 
0.2@0000E+00 
1.0@0000E+00 
moe OUtTpDUL Matrix C is: 
1.00000H+0@ ®.Q@0@000HK+00 @6.00000EFE+00 9.800000K+00 
02.00000H+00 1.@0000E+00 0.000005+00 0. 0@0000H+00 
The desired feedback coefficients are 
2.00000E+01 
1.3@000E+01 
-6.90000E+00 
-3 .0000EH+0@ 


The Observer characteristic polynomial coefficients 
in ascending powers of S 


1.40000E+@Q1 7.50000E+00 1.0@0000E+0@ 
The F Matrix is 


—~7 .5000H+0@ 1.0@0000E+00 
-1.40005+@01 @.00000E+00 
The G1 Matrix is 
8.55000H+01 2.92500E+01 
@.@0000E+0G0 @G0.00000E+00 


The G2 Matrix is 


-3 .90008+00 
-1.5000H+00 


The output feedback coefficients are : 
2.90000H+01 8.50000E+00 

The compensator feedback coefficients are 
1.@0000E+00 @G.90000E+00 


Figure 4.13 The Luenberger observer design output. 
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example, we want to design observer eigenvalues of 
—-3.5 and -4.@. 


Step5 

The program results for all this input data is 
shown in Figure 4.13. Prom results; the compere 
system can be described as: 


0.02 1.0 0.0 0.0 x1 (+t) 0 

; 0.@ 0.@ 1.@ 0.0 Xo(t ) Q 

x(t )= E + u(t) 
0.0 9.09 0.0 1.0 x3(t) 0 
WME 1 25, 7 33, x4 (+t) 1 


Se arse eo z3(t) 85.5 29.25||x1(t 
vod Tee] Lae + Ss Selle 


F. DESIGN OF OPTIMAL CONTROL 
The system considered is described by the following 
State variable equation: 


x(t) = A x(t) + B u(t) (4-26) 
where 

x = State vector 

u = control inpwte 


> 
ll 


plant matrix 
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B = input matrix 


mee 6design St eoptlicelmemcontrol wills) minimize the 
Tomnoewins cost function: 


N-1 
J(N) = 1/20 xt(N) Q X(N) + > _[X(k) Q X(ik) + R U2(K)] 
k=@ (4-27) 


Where the following are defined 


Q = noise covariance matrix 
N = time intervals over which the SUM is made 
R = scalar random input 


and XT means transpose of X. 


The physical interpretation of J(N) is this: we 
wish to keep the state near Zero without excessive 
control energy expenditure. The input parameters of the 
design of optimal control are entered in the beginning 
of the program. This screen can be seen in Figure 
. es After entering these parameters and the Q 
Matrix, then the program calculates the feedback gain 
matrix which, when multiplied by the state vector, 
Yields a scalar control. In the program procedures, 
the following equations were derived using dynamic 
programming, starting at the terminal time and working 
backwards. 


P(k)=PSIT(k) * P(k-1) * PSI(k) + Q + GT(k) * 
R * Gtk), P(O)=0 (4-28) 
PSI(k)=FI + GAMMA * GT(k), PSI(@) = @ (4-29) 
GT(k)=-[GAMMAT * P(k-1) * FI]/[GAMMAT * P(k-1) * 
GAMMA + R], GT(0)=@ (4-30) 


4°7 


*** Design of optimal control procedure *** 


Input number of time intervals for SUM procedure? 
What is your sample interval? Oa 
‘What is the value of scalar R? ZO 


For the following epimons which cost funeiven 
do you want? 
COST=terminal+fuel+trajectory or 
COST=terminal+trajectory <O> 
COST=terminal+fuel or COST=terminal <1> 
where 
terminal= 1/2 XT(N) Q X(N) 


N-1 
trajectory 1/2> X(k) Q X(k) 
k=@0 


N-1 
fuel = 1/2>_R U2(k) 
k=0 


Press <BESC> to change it!, 
Then type your input with <ENTER> key 





Figure 4.14 Optimal control parameters screen. 


For simplicity in programming, the following 
definitions are defined: 


Terminal= 1/2 XT(N) * Q * X(N) (4-31) 
N-1 
Trajectory= 1/2 > X(k) * Q * X(k) (4-32) 
k=@ 
N-1 
Fuel = 1/2 ) R * U2(k) (4-33) 
k=@ 
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EXAMPLE 4.3 

Given the system equation and parameters described 
below find the discrete steady state gains for a sample 
Pmamerval 0.1, scalar R is 1.0 and number of time 
intervals is 4@. 


° Q 1 0 
ue)-| 2 , | SCG oa: |S 7 Ele) (4-34) 


The graphic result of the program is shown in 
Figure 4.15 and Figure 4.16, the numerical output is in 
the Figure 4.17. 


4 
tiie THEmsacs ae 





Figure 4.15 Optimal control graphic output #1. 


G. MATRIX MATHEMATICS MENU 

This option is used to get various calculations 
with the plant matrix A of a given linear control state 
variable system. The selection from the SVS main menu 
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brings the matrix mathematics menu. This second menu 
consist of following options: 

(1) The determinant of A matrix 

(2) The inverse of A matrix 

(3) The characteristic polynomial of A matrix 


(4) The Eigenvalues of A matrix 


Before selecting this option, the user must select 
"Input/Change Plant Matrices" option to enter the 


plant matrices. 


q 


4 
THe DIFERUALS > 





Figure 4.16 Optimal control graphic output #2. 
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Figure 4.17 


V. CONCLUSION AND RECOMMENDATIONS 


The software, SVS, is written as a teaching 
learning tool for student use. It can be a nice tool 
for analysis and design of linear control state 
variable systems. The program is fully interactive and 
menu driven. The user does not get lost in the 
program. The <Q> key always returns to the main menu 
or CTRL + C key interrupts the program. All options 
were tested solving several example problems. 
Hopefully, all "bugs" have been eliminated. 


Bie tive rie iC) saat program can still be easily 
improved and expanded. These are listed below. 
(1) Adding the ability to handle the KALMAN 
filtering. 


(2) Add the capability of the program to handle 
discrete time systems. 


Die 


APPENDIX A 
UTILITI FILES 


A set of Turbo Pascal input and menuing utilities 
was used widely in the program. These are public domain 
utilities and was copied from the LCS-CAD source 
diskettes. These utilities, called TURBO-UT.PAS were 
written by: 

Donald R. Ramsey 
Larry Romero 

727 Bunker Hill #790 
Houston, Texas 77029 


and distributed through the public domain. The 
describing documentation are presented on reference 4. 


a2 


APPENDIX B 
PROGRAM LISTING 


Appendix B is a listing files of the Turbo Pascal 
source code. These files make up the major modules of 


the SVS program. In general, most of the driver 
programs and including files are listed in the 
following pages. The source modules from the Borland 
International Turbo Graphix Toolbox and the 


input/output utility reutines vane Notre ved. 
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Program State Variable SY stem put, ,output ) ; 


rs eke Oa x Ce ane HHH Oe HHH KRHHHHHHHHE * ) 
The following include Files” eee procedures *) 
to handle graphics call from the main procedures} } 
of this program. These include files are a part * 
of Borland International’s Turbo So TOOlbox* ) 


Which is a commercially available pro GuGiee 
HHH HMH HH HH HHH HHH HHH HHH HRHHHRMHRHHNHH HK KR HK MMH HERR HES Q 


OK OK OK KOK OK 


peecee. ~-SYS} + zee & variable decleration) 


i oep 
tet Box.1INC} raw the box for the main menu} 
* HHH HH HHH HH HHH HHH HHH HHH HHH HHH HH HHH HHH MHRHRHRHRHRHH HE % 
* These are ee procedures andy runcLlOns TO) * 
* hel in nput They are public domain pro rams. * 
* * % * KH KKH RHR i a a HRHRHRHHHHHHRMRH HE HHH HHH EH 


{ i eae Ne) {I/O procedures } 
Ll Ut-Mod@2.INC 


Procedure MainMenu; 
Var 


=,Tab Integer; 
Hel 2 ee ee ie ae ee 

lotfile ae Lovee Ob Ser hile, 

uenberg¥ile, PoleFile, OptimalFile File; 
Beseription : Strso: 
Okchoices : Set Of Char; 


ae aera aa e 


‘ Displays warning about program end) 
2 


cr; Highvideo; 
Gir es Xo" wanted ending the SVS program? ( Y/N ) 


Lowviaed: 


eee 
Op on 
meenet (Chin [?V¥',’N’ ]) then Beep(900, 550) 
Until Ch in [°Y’,’N’]; 
End; 
Procedure Menultem(pick: char } cescrp tom str8@; 
colo nteger 


as. { allows easy Be cieaen of main menu colors) 
egin 
GeEECPHOr (ggLO" Vi), pe 


Write ; es Tome ce i mot pick): 
TextColor(color descrip es 

End ; 

Begin { Main Menu } 

Piocrs 

Tex Color(1i htblue); 
Msg a oo. school Ismail 
GoToXxY 1? a extColor(white); 
GoToxY (21 5 * SVS HEN MENU Hex TO 


show main menu ) 
Yuiteln(’ uN 
Bab : 


Menultem(’I’,’ Input / Change Plant Matrix Menu’,red); 
Writeln; 


Menultem(’G’,’Graphics Menu?,light )3 
Menultem(’C’,’Con Po leliah alt ie ye Wei tgw) 
Menultem(’O’,’Observabilit ye 
Menultem(’L’,’Luenberger O server Design’ ,yellow); 


55 


PIewey >. PAS Pregremeahisting Page 


Menuttem |b)» penaen of Optimal Control’ ,yellow); 
ae ea >P’,’Pole Placement’ ,yell Meat 
riteln: 
Menultem(’ M’,’Matrix Mathematics Menu’ ,lightgray); 
riteln; 
Menultem( ?H?, }Help’ Hee eae 
Menul tem ’ Q’,’Quit the program’ ,lightmagenta); 


Bo 

ae not (block1 in Uh 3 aoe Oe] 
ice we OO” 7—’ 7M’ 7p? 
9 9 


Kchoices:= A 
else OKcho s:2f 07 ; ; , ’ 
'G Peel ye cane 
Repeat {sets legal choices depending on user) 
ODG done 


if not (ch in okchoices) then 


= 
ie Peas then 
an: 


“Been (9 TG: Hai Sop Een He or OUT 


End; é 
End; TextColor(white); 
Unti een am Okchoices; 

aa Ch Oat 


Be 
“Aas tanCTHRBMEAS >Input.com’ ); 
Execute(InputFile); 


Has 
ReSign (WatrixFile, Matrix. com’ ); 
eee 


End 
Ge Be 
feSian( Pl etiile, plotrcem). 
Execute(plotfil Ba 
Cue ie 
; ssig Controwr: 1 ; Gener ols elim” ): 
Chain(ControlFile 
TiC? oe 
j eae (obserFile, ,’Obser.chn’ ); 
_Chain( bserFile 


Aves Be 
gin, | {uenbe nate ,’ Luenberg.chn’ ); 
ie uenbergFile 


7D Se 
gin. (optimalfile,’ optimal@ehnwa: 
nd; optimalfile 
erie. * Begin 
ssi os 1 .chn»< 
“Ghatatnelp a 
Pes Be in 
Dn 
Execute( PoleFile); 
nN 6 
a Begin 
ay 
if (ch={="Y" ) or (ch”= y  ) fenen 
Exit <= True; 
End; 
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End; {case} 
End; (main menu) 


¥*& 
* ogram Execution part * 
rs. , ewe. 2 HRHHRHHHNHNHNMHRMMRHMR ¥* 
“Bis {svs)} 
IrScr; {clear screen) 
Bx ae False :{initialize boolean) 
ae 


i miloc ia <> 1 then 
Be 
°E lou eo 
Me tailenus (fecal mata eu until the user 


Want to exit 
meet Bxit= True: 


* ie ee ne et 
HHHHHH HHH KH 


Set Cap Num(’ °’,! °,’ °):Say Cap Num; 
—~eP_ ( {set ca S, insert, and num lock off) 
Bleek! := @; {reset problem 
End. (svs} 


Dt 
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oa input ( inputmewmocrcen 

{* This program allows. the user to enter,change,save 
and retrieve a problem for the whole options on the 
OtReEr menue Ss .- 


{$I Typedef.SYS} {comman type & variable definitions) 


I Ut-mod@1.INC} {1/0 utility routines} 
I Ut-mod@2.INC 
I Ut-mod@3.INC 


{$I Box.INC}) {draws menu box} 


var 
inputdatfile,savefile,retrievefile, 
changefile,help2file : file; 


Procedure Inputlvemue: 

Var i, Tab. ; integer; 
Okchetces : Set_Of Char ; 
Pintsped >: Boolean; 


Procedure MenulItem( Pick:Char;Description:Str8@; 
Co or: Integer ); 
{displays menu items in color } 


Boman 
extColor(color ); 
Write (’ = Tepel or (?); Text oor oe es te( pick); 
_ SoS or(color); Writein( 2 como 
nda; 
Beam 
inser ; ome ee Finished := False; 
GoTox (20,4 ; retriev:=true; 
Write(’*** INPUT / CHANGE MENU. *** °); 
for i := 91 to 4ideo weiteln er 
Tab := 1 ; 


Menuitemt Rn es Plant Matrices ’,red 


); 
Menultem »’Change Current Plant Matrices’ ,yellow); 


Writeln; 
Menultem(’S’,’ 


MenulItem(’L’,”’ 
Writeln; 
ene oe Lightmagenta ); 
Menultem(’Q’,’Qui to SVS Main Ménu > ,lightmagenta); 


Box; TextColor(white); 


save Plant Matrices to Disk 
Pile’ ,yvel tows ; 
Load Plant Matrices From Disk 
Tt uae eee rae 


Set Cap *num( °C’ .’ ° 2. esac um; gotoxy(40,22); 
if block! <> 1 thensomenoaor es ohm aa om) rar] 
else OKchoices :=|[’I’,’ eS Le ile 
Repeat {wait for user to input a keyprees} 
Opt 1LONn-. 


if not (ch in OKchoices) then 
ee 
er Ree 350);:TextColor(red); 
Lis % ocki”° <>°i then 
begin 
msg(’WARNING: First Fa ees OF 
OuUrT pl eee) s 
end; 
end; 
TextColor(white); 
until Ch in OKchoices; 


58 


fae: ENPUT.PAS Peegram iis t Lae eer 2 


case an a 
oT be 


Seren meeedaeen pee SnD a Orie 
ee eee le 


Pe? Sas 
ws (retrievefil ee Gh) e 
Chain(retrievefile 

"S)) Senin 
Rssig (savefil os egal ))s 
Chain(savefile 

ee a 

? ? e 
Rssig (changefil eC anee™ Ghn’ ): 
Bete changefile 

ee me 
gin. ee panel D2 cee 
ees 2 help2file 

my? ¢ 


begin 

Ssimn(svskile,’svs.com’ ); 
eee ae svsFile); 

end; 

End; {case} 

era ; 


{ Execution the input/change menu program. } 
Begin (main ECE e am) 
rive 
repeat | 
aputMeny; 
Une 


Boatshed. =. True; 
End. {main program 


eo 
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Program input_data(in 


tte Ole piurt ) 


{To allow thé user we enter the A,B,C matrix from the 
this program 

label 13;label 1@;:label 11; {label decleration for the 
GOTO statement } 


{$I Typedef-.sys}) {comman variable declerations } 
aa Die Gere {I/O routines} 


Ut-mod@2.inc 


var Ans,Cont eC iaiien 
SESE pte T Space ee 
epping,Step,Steps, 
Semp1 Tempe, i. 4 E ; Integer; 
Resul eRe ame 
inputfile : file; 
Begin {input data) 
132:CirScr: Writeln: 
block t=( > tex colonic una 
Write(’Enter the degree of the plant: °’); 
Readin( size); 
Le (size <= @) or ( size >» 10) then 
egin 
beep (900,550); ove lke 
end; 
for Steps: — weston) ode {initialize} 
ior sFepping >= 1 to_1@ do 
A1ALsteps,stepping] := @.@; 


Writeln(’Enter the elements of the A Matrix ’); 
ieeicol aa 
for steps := 1 to size do 
Begin 
or stepping += 1 te size We 


Begin 
Write(?A(’ steps i265" ,steppame, >= *): 
Readin(A Atsteps, steppine!): 
End;Writeln;: 
End; 
= PEGE , 
lrscr; Writeln; 


Writeln(’The A Matrix is : ’); writeln; 
for steps :=1 to size do 


Begin 
for stepping := 1 to size do 


rite(’ _’, A1A [steps,stepping]:11); 
End; Writeln; 
End; writeln; (prompt to any changes } 
Write Do you want to change any element ene. Ses 
write(’ the Matra <7 Y N ) : 
Read(Kbd,Ans); writeln; {allows Beco to change 
entered data 


1f ( Ans =’Y’) Gr ( AnSwee yy) teen 

Begin 
write(’Input the row to change : ’); readln(i); 
Verte Coser : se 


readin 
write(’ 9 +» 3 
ATALS, -=result: 
nda; 
Until Anemia [ Nose na: 


Bee aa ota 
user inputs B matrix elements from the keyboard) 


? swriteln; 


nout the column to change 
j,’)= ’)3;readln(result); 


6@ 
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write( ’How many i Mout Seiclomyoun lave. 7 amo): 
iS Mmcai ) Ne el 

aa en ma < Or (ai >» size) then 

an Boer (999, 35@);goto 10; 

for ste i Eo 1@ do 


fee Stepp ine: to_1@ 7 


a e in : 20s 
esi. = a Seton ppi a sees of the B Matrix 7a 
Writeln: 


oe steps := 1 to size do 
for COR has =e UGmaal. iO 
a aa 
Rite(’B steps, ,SteEPPane, ) = Js 
Readin( 5. [ a Beene yes 


end; aoe ms 
End; Writeln; 


Re 
peat. Write ine 


Writeln(’The B Matrix PSone )s wie lime 
ees steps := ee size do 
e 
for Sieppama: to ni do 
be 
Pe reil excep panel iis 


end; writeln; 
End; Writeln; 


Write(’Do you want to chan any element of’); 
Beas (one iF Matrix 7? ¢ v7 N \ ie 

ea 
oR: (al he er to change B matrix element) 
a Ans = a ANS =’y°’) then 

egin 

ee ee iieewrow tO Chance...) )- peaaTiw!) 

mini tet put taercolumn to Cnanze < * ); 

readl a. rc ne 

ms feet 7,J,’)= °’)sreadlin(result); 

Beet 


ee tl "Ans in [’N’,’n’]; 


peemiocr; wWriteln; 

{user inputs output data from keyboard) 
write(’How many outputs do you have ? ee 
rea aero 

eh no i ) or ( no > size ) then 


be 
8285 (900, 7 a lind 


eee steps: do 
or S eppin ae 10 PD 


Clst eps, ngist to, V0 -@; 
write 


ea onea Eten. the elements of the C Matrix °’); 
Wratedn ; 


oe SLpepping := 1 to no do 
Be 
for Sepa — |) vO Size do 
Pate tte( 2 hae el ae eo ee _— 
Readln( C[stepping Leese 


end; writeln; 
End 3 writeln; 


Re eat 
CirScr: Writeln; ] 
Writeln(’The C matrix is : pe weiteln: 
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aoe Stepping := 1 to no do 
Be 
ae SED Sis 1 to size do 
eke ee 
rite(’ »CLstepping,steps]:11); 
end; Be ceine 


End; Writeln; 
EELele Do arg want to chanes any ¢lement OL 


writ the , write a 
ee ee Ans) wri eln; 
if Or Ans =’y’) then 
egin 
gle yoo the row to chnage : ’); readlin(i); 
write(’Input the column to change : 1: 
readl i ; ey 
W ital! ‘t »oj,’)= ’?)sreadlin(result); 
Cri, | =result 


End; 
Minti Ans in ie ee 


ween (henskegurs she ti NeOm i. 

re-execute,.the input/Chang e menu program) 
are tetas 

End input data 
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Program change data(input, ,output 


* This program allows the user to change A,B, C 
“matrices and their matrix order. 
* HE EHH HE TE HE EE EE EE OE EE HK 


abel 11;label 12;label 14; 


> 
i HOH EK 


KK OK 


{$I Typedef.sys)} {comman type & variable decleration) 


I ey oea ey {I/O utilities )} 
I Ut-mod@2.inc 


var Ans,temp, sanputtype ac hnar’s 
Stepping, ,otep,Steps,i,j : Integer ; 
Resu ; Real; 
rn pU tie le : file; 
result_size ; integer ; 
Begin 
Girsers;wrimbeln; gotoxy( 1,22); 
inyvid aa ss <ESC> to BNO BG dee, ae 
Otoxy 
ati cys input your choice with <ENTER> key’ ); 
Otox : 
eee at ghtblue); 
writelnt? eH ponge Current Elawe Matrices 


Procedure ***? 
Be eeGaCs yellow); 


writeln SSSseseeses222S22SS2S2S2S2SSSS22S2e2rezz===’ )e 
Mszg pootort matrix do you want to change ? ’,1,6): 
textcolor ial Henin 
msg PANDA) ° ,359,6); 
ms2 heute) ° 1,7): 
msg OUT E@iwCC) *,1,8);3 
es sat 

ae Tomita, oO: of a rue, F1,F1@);3 

em Bees 

dete Mot” ony (ar in Frat! »,°?C’]) then beep(900,350); 
fenraet ae 1 temp _ in eo es 
iio bt cy De. ceomp, 


case Popeye’ OF 
"A’s:begin 
14:ClrsSoer ; 
cea »The A mai wl owe); Writeln; 
ior Sues: al 26 size do 


°° For 
or a =1 to size do 
Cae ieee ,A1ALsteps,stepping]:11); 
end; resin 
end; writeln; 
Write(’The oor Sy, of the system is:’, 


a A 
weve eee 


C200); 

repe 
Se aimed sch), 

Mini ech a N’, Peer oe mal 

tt Cehevay’ ) cor ne? y? 

begin 
write 
Wa re hhe Sricen oS the system is :’); 
nea Inm(resulteasiz 

result sizZe<1 or (result_size>1@) 
ved ee | 


Beet 000,350); goto 14; 
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end; 
Size:=result_size; 
end; 
repeat ; 
Clrscrewritelin; ; 
Writeln(’The A Matrix is : ’);writeln; 
SS steps <=! to Sizerde 
e 
for s — 2s= 1 to size do 
egin 
Rhea e(? > A1ALsteps,stepping]:11):; 


End; eee igi 
End; Writeln; 


Write(’Do swine to change any element? 
Read(Kbd,Ans);writeln; 
at ot ns in ee in 7 then 
dL ¢ Ans =’Y’) (’Ans”’=’y’) then 
Begin 
pen pate row to change : ’); 
readin(i 
write nout column tovwechangce ss a. 
read heise, ee ee 
write(’ ‘ 


d n(resul ‘i ee 


reac 
A1ALi,jj:=resu 
Ena: 
Until Ansin | N’ , aa 
elec, 

"B’ :begi 

aie. TClirs r 5 

writeln(’The B matrixwvis “23s write ina. 


ueNe Seep s =) eG size do 


2eeee 
or oo CO ele 
begin 
write(’ »BLsteps,stepping]:11); 
end; cre eonae 
end; writeln; : 
Write( >The nu : un Input, 1S ! “Smee. 


ange ? 
eat peal yhgs hs 
ch it ae le 
cr or (ee eoaee then 
egin 
eo {allow “a user. to change number 
of. impit ae 
ee he number of input ies 2 7 us 
result size 
if. result _ size or (result _size>1@) 
then begi 
beep( 900, 350)* gotou ln: 
end; 
ni:=result size; 
en = 
repeat 


C1Irscr:-wratela: 
Writeln(’The B Matrix lowe); writeln: 


oan eel :=1 to size do 
Be 
fer ateppina c= 1 to ni ede 
Be 
Write ag steps,steppin a 
End; Writeln 2 pping]: 


End; Writel ne 
{prompt the user for changes on B matrix) 
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Page 3 
Write(?D yo W Ht to change any element 
Pent areh hl riteing 

ot (Ans in aN n’ J) then 
ea = ys . or (Ans =’y’) then 
Boe ae 
eae ut row to change : ’); 
read aie 
write(? n ut column to Chances.) 
rea 
ee ae write( BC? Sud crete) ae ees 
Se eee 
es =result; 
gntil "Ans in [’N’,’n’]; 
Ge :begin 
2 Eirs 


r i 
writeln(’The C matrix is :’);writeln; 
for steps:=1 to no do 


be 
ae Sov pae to size do 
pein 


eee si ae stepping]:11); 


{allow the user to change number of ete 
Write ee pene MerOlisolla 16° VO) S 
write ; es ? nla (sy Nie 
mee at feadtk 

Uu alee gh? Tne 2m’ Ie 
sty ae a ) or (che se he 
begin 

writeln; 


write(’The Number a OUtpuee rs 7 Js 
if-Cresure si siz 


result size<1 or (result_size>190) 


then gin 
beept 90,350); goto 12; 
en 
no: -result eee, 
en 
repeat 
clrscr;writeln;:{show C matrix elements} 
Writeln(’The C Matrix is : ’):writeln; 
Hew Steps :=1 to no do 
2 
for ae := 1 to size do 
te a steps,stepping]:11); 
End: 1te(? | in . = ns 


End; eee: 
{prompt the user for changes on C matrix } 


Write(’ a a4 ae ae to change any element 


os Kb Ans 
we (Ans in then 
Ca =’Y’) y’) then 
bee in 


"rela i ue row to change : ’); 


Petaleiaay, 
or 


read 
write nput column to change : re) 
mead 
writeln; eee ore ies 2? y=): 
of Ses}ieresure? 
=result; 
End 
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Unitas Aina ree lee ee 
end; 
end; | | | 
Assign(inputfile,’input.com’); {re-execute seus: 
program 
Execute OP ae 
End.{ change 
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Program save_data; 


SI eee 
$I Ut-mod@1.IN 
$I Ut-mod@2.inc 


var. 
Pele nanecw= - Str2d; 
paaociki ile beg: 
*, 3 : pinteger ; 
inpu file le; 
begin {Save eet 
Te HighVideo; 
eer user to change drive if necessary) 
Msg oe Como cp Drive is -. Press <esec> to change 
repeat 
input ¢ ’ A’ ,copy( 
py( answe 
$B oat ie 
besp( 359) 
maciliech in (2 
Drive := CBee CS 
Clr Crs 


Vv tye 52,11, 2strucewu1. Fld): 


drive.1, 
r,1,1)5 
eee se ee DB a) then 
bee 39 IDPs ee 

ompt or filename to store data) 
msg Input See POF file to save data in File’,1,190); 
writeln: write 


writeln(’*** Y ur DATA disk must be in drive 
» Drive ee) 
input ( ? ae 8,true,F1,F10); 


ename: 1729495198, tre copy(answer,1,8),’.svs’); 


Assign( 
rewrite 


1 ckfile, ilename ); {Open file } 

Writeln(B 
B 
B 
1 


ockfile 

ckfile, size); 

ckfile,ni 

Gian i 165 ne 

O eae do 

wo FSi 2 do 
lockfile, Aiwa. aes 
pata do 


do 
Mb ockEtle, Bites). 
to no ace 


Ot Ht vO 
eee OT CCR EL ie Soe le 


pe eseaied > {close oe A bke | 
ae impubtrile,.’ Pope cen: re-execute 


input/change menu program) 
eeeee’ jaeay tte? 
star Save 


eriteln 


P=OO0 ctO00 
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retrieve Se 
(Soe iepedens SYS) variable decleratios)} 


I Ut-mod@1.INC} {I/O routines} 
I Ut-mod@2.INC 
I Ut-mod@3.INC 


{$I Directry.INC} {shows available dao 1 les) 
var 


readfile : text; {The text file user will use) 
filename : str2Q; 

Peace mnol : boolean; 

linecountereas ee integer; { A counter for the 


es we read 
inputfile, PileeE ies file; 


begin { procedure retrieve data) 
lrScr;HighVideo 
A Al Low change of disk drive if desired) 
O 


Msg ae “Your data drive is - Press <BSC> to change 


aoe ae 

ape Gees copy (drive .1)4352,11;)23 bruce, F bier 
pyla ans er vm: 

on n E¢ch , 6? ,’? Des 7 paeeen 

bee BOOB 2); 

aaa ch ioe g "B’, \G? hae 

Drive: concat(ch, : 
( tion, 20) to display eligible eee 


Direct PC Cate xtension,filename,readerror 
TE not rondennet then 


Be 
RsSien(rgaaet ie. filename ); 
pen t é file and read contents } 
Reset (readfile) 
Linecounter: {count the lines } 
While not EOF 1 en do 
{The built-in bene pe noe returns ene 
conte if the end of a ay been reached 
inecounter: oC ipecaun tertt 3 Count the next line} 
Readlin(re dfile, size 
ead it into variable line } 


Reagin(reagtife, aie 
Readln(readfile,no 
Idee a8 =) co size aon 
For j:= si 
Re 2 AGreaclatales SM j]); 
For i:=1 or anae do 
FOr ejec= do 
Redln (eee ester 5 eel 
For i:= 1 to a e2 
FOr 4k =12 26 
Read(readtile, e a jes 
End; Close(readfil e); 
nd 
Llse 
aoe 


el ay 
¢ Wait for directory error message and continue} 
Window 1,1,80,25); 
LeSers 
ind ; 
{ei not (retriev) then 


be 
eaten ( OMe oa eno ue COM). 
Execute(PlotFile); 
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end 
ees ce 
begin . 
Assign(inputfile,’input.com’ );{re-execute 
. oa Guenee menu program) 
Execute(inputfile); 


en 
End. {retrieve data) 
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Program Plot; 


Program plot contains graphic pre@grams. They are 
written DY WOOD Roy, Jr. and modified for this 
program. 


{$I Typedef.SYS}){type and variable decleration routine) 
I Ut-mod@1.INC {I/O routines } 
I Ut-mod@2.INC 
I Ut-mod@3.INC 


{$ eB ose ENC } {drawing menu box } 
VEL 
] Integer ; 
we p4file,Retrievetile Nyaquistirile 
timeplotfile, bodefile, rlocifile, oa aaa 7 Bee 
Procedure GraphicsMenu;3 
var 
nf db elem : aeeeeed 
Okchoice : 8 énar : 
Finished : Boolean; 


Procedure Menultem( Pick: i) >DescriptLonssctunrc?’. 
olor: Integer 


Be gives easy Selection of input menu colors) 
‘ea 


Write : tab (? Des olor(white ) te(pick); 
s TextCo or(color)} Weit ee +S need Pet: a 
na; 
aCe 
IrScr; Bot Bares Gotony ( 
Pini shed 20s ecteq oo ee 
riteln ° 
MENG te graphics menu) 


foarte 

a = 

Menultem aie >Load Plant Matrices From Disk 
File’,red); 

Writeln; 


Menultem(’C’,’Characteristic Equation Roots’ ,yellow); 


MenulItem(’B’,’Bode Plot ’,yello W); 
Menultem(’T’,’Time Response ilere ellow); 
Menultem ’N’ Nyquist Deu, ello ws 
Menultem(’R’,;,’Root Locus Plo vel ow )3 
writeln; 


Menultem(’H’,? ee ightmagenta ) s 

Menultem(’Q i Ue VS Main Menu ’,lightmagenta); 

BextCoior (aren) 

Box; Writ 

TextCol rCwhite)s retriev:=false; 

Senet 4 

repeat { read user choice from keyboard) 
optio 

until ane jin. (€°R’,.°?D?,?B 5 Dy) Nee ee ees 

case ch. oF 
"R’ :begin 

assign(rlocifil , Phoe eae 7 

aeae rlocifile 


ES 
gin. (retrievefil yp Feta Ie ec una: 
ane retrievefile 

en 
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be 
eo ciec (tameplotey | ee re Sian: 
eee timeplotfile 


>B?’s me 
“Eeleer(aasetiay a BOdee elm: ).- 
Chain(bodefile 


‘anh begin 
chain(Nyauistiiled | » Nyquist.chn =e: 
hain(Nyquistfile 


mC enc 
ae (rootsfil ego eS Chee 
aghain(rootsfil le 


aS Begin 
Ghaif(herperiie): me Heda © HN a 
n 


Chai elp4File 
End 
O72 De 
sSign(svsTile, 3s SVS.com’ )3 
Execute(svsFile 
end; 
End; 
End; 
Begin {plot}. 
grive PG” 
Meee al ize drive selection for load procedure} 


repeat 
GraphicsMenu; {repeadely call graphics menu until 
user selects to quit) 
Dial. Ae ished = True; 


Bag. {pl 


ra 


FILE: BODE.PAS Program Listing Page 1 
{ BODE PLOT is the driver program Stowe atiee oa 
plottin routines. It simply invokes Bode plot, when 
Finished, returns back to the graphics menu. 


Program Bode; 


I pe oe eee {graphics routines) 
I Graphix.sy 
il Kerieiweesyc 
i Windows sys 
O on. 
I AST Se Ren © 
I Ut-mod@1.inc {I/O routines} 
il Ut-mod@2.ince 
I Ut-mod@3.ince 
i “Gea eae { raph options menu} 
I PlotBode.in ode plotting routine) 
I Boxuser.ince 
ie oo 
we ary4 = array ee of real; 
aryO = array [1..21}) of itmtecer- 
var 
plotfile :file; 
ee Polynom.inc) Polynomial routine) 
P@Reots ind sine) {Polynomial roots finder routine) 
{$I Bodeplot.inc)}) {Bode routine} 
begin : 
BODEPLOT; {call the Bode calculation routine) 


Assign(pnlotfile,’PLOT.COM’ );. 
{ -execute the graphics menu routines) 


re 
Execute(plotfile); 


end. 


Ve 
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Program vane eet 
lai l 133 label decleration for GOTO statement } 


mech Sys } (e@raphics routines} 
Graphix.sy 
Kernel .sys) 

Windows.sys} 

Me1Ls hg 

Polyweon:.heh) 

Ut-mod@1.inc {I/O routines} 
UT-mod@2.inc 

Pcemoda>.inc 


{$I GrapMenu.inc}) {graph option menu procedure) 


AAR AAAHHH 


Ree RAHA E444 


type 
ary4 = array hams lid of real; 
ary oO = array i 1 of integer; 
var 

Pol PnisA, Atemp > aryis; 
temp , oe Seo S : char: 
Offset,Slope, Imax 
RowSum,MaxRowSum,tf, 

T1,01ldMaxRowSun, 

neeoctame,Ulnput, Phix, 

hold, Ymax,Ymin,fPlot, 
Amplitude, Freq,y wee oan, 
Bactorial, Plotindex, 
Mencr,code,i, 

des m,n,kk,cnpoles,sizezero : integer; 
umpGraph,GoodNumbers, 

ClosedLoop,quit : boolean; 
C1,Xo0old,Xnext ,Gamma 2 Vay Sis 
eee eyo Sau Larhay ; lotarray; 
Lis CexXt ; 
numcoeff,dencoeff,cdencoeff > ary4; 

: integer ; 

plotfile wet ile: 


bet een: Ine {characteristic equation procedure} 
I Boxuser.inc 


Pegceaure PrintGraphData; . 
(this procedure dumps time-response data to printer} 


Begin 
he eee achic+Cirscr: 


repeat 
ier tcol (white); Boe Nee a 
goiselesg ie ROGRAM OUTPUT OPTIONS *** °); 
Otox ‘ : 
eit n(’<P> Printer output Ne 
Textcol Grell ow ; POLOxmee”,.14 ) 5 
write € Check Your Printer! a 
Textcol “ete )- BOrexy 20, 15 76 
een ee tomsbile mame eS 
Otox ; ; : 
write ? ; mC the current drive Gs 
OTOX » 2 
rite "<Q> Quit : > Bb Te) 
ey ( 2,15);textcolor(yellow);write(’"TIME.RES"’ ); 
Zoto eeaygh |r 
read( kbd,ch);3 
if ¢ h='F’) or (ch=’f’) or (ch=’P’) or (ch=’p’) 
en 


fe 
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begin 
if (ch = 9) orm@(che— ° fee 
begin 
Zotox (24 Pe ILC GS 
write(’PRINTING..... >); 
assten( | tse RES’ ); 
rewrite(list); 
end 
else 
begin 
ZOtOX: (24 Lap ggextcolor (red); 
write(’PRINTING........... >); 
Rewrttedl St, Ebel: ): 
rewrite ae 
Tauit 6 ImiClaiee TIME RESPONSE PLOT 
RESULT >); 
writeln(list); 
writeln(list, TIME oo) Y 
( output R 
Cis eee 
writelm(ltse) 3. —----------------------------- =: 
we oa ae 
i ss 
writeln(list redeieees ,1]:10% 34” ai 
GranhaAr snaefl 
InputArrayLi,2 
en 
raced ven in (1? .Q*. Cau 
EnterGraphic; 
swapscreen; 
close list); 
end; 
Procedure Matrix_Mult(Matrix1,Matrix2:aryis 
var AnswerMatrix: ryl ae 
Rae Ur cdene -integer); 
VAT (aed ; integer; 
beeen 
or i:=1 to order do 
IOPO Ng) = — Le gigioy ie oWeic C7 
AnswerMatrixlLi,j QO; 
{initialize one answer matrix) 
for,ic=.~1 togor dexmmide 
for jt= 1 to order do 
Lor: liv: 1 to nog do 
AnswerMatrix nswerMatrix[i,j] + 
Mates fie Lj] *Matrix2 L* ao 
end; 
Procedure Scalar Mult(Matrixi: rye scalar : real; 
var Answerifa rix®: ary is; 
Order:integer 
var i,j > integer; 
een 
Ore ee to order do 
for 4: ue tO len O 
. AnsSwerMatrixli,j]:= AnswerMatrix[i,j] * scalar; 
end; 


Procedure Matrix Vector Mult(Matrix1 :aryt 
a oa Vector : ary3 

var AnswerVec 

r 


S> 

S>5 

COR a age 
order: integer ); 
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Mais 1, J >: integer; 


a 
or a: to order do 
poe sn 
6ld:= @; 
*holdi= noda°e Hath ixt (4, 4] *vector (3): 
= O a gps *Vector 
AnswerVector rice | fi. J J 
end; 
end; 


Be 
fn tgraphic: ;leavegraphic; 
Boxuser; 
Characteristic Equation(A1A,size,Dencoeff); 
calculating denominator coefficient) 


mOomel:=1 to size do PSIf{i,size]:=B[i,1]; 


for jj:=2 to size do 
i ate 
or 1:=1 to size do 
Pao ie 
eee 
kid : 13 


Pema nad sDencoeffi lik ] oy Vehligatgee| | is 

for 1: Te size 

.Psi(i, jJ:= PSI[i, 47 +A1A[i,1] * PSI[1,kk1];: 
em 

end ; 


mor it = 1 oy size do 
a numerator coefficients } 


be 
*fumcoef fil: = 


-O; 
for ioe do 
Nuincoer ff 4 i = Numcoeff[{i] + PSI[{j,i] * CL1,i]; 

en 
for | i:=1 to size do {calculating numerator order } 
e in 

= ;=Ssizet+i-i 

it emeoctfiml <> 0.0 then moto 15; 

en 

13:sizezero:=m-13 

Cirscr; 

TextCol r(lightblue ); 
writel tnt ** Time Response Plotting 


Parameters ***? ); 
7 xtColor(yel ow) ;writeln(? ===s=s=2=ss=ssssss=s=ss=’ 
Msg(’What is your input to the system? STEP (8) 


1 
Msg( J RAMP (R) 
Msg(’ SINE wAvEE’ W) 
Mse(? IMPULSE (T) 
re 
Tnput ( eS 5 0., Or, 2 e,F1,F10); 
mp := copy(ans er, - 1)3) 


t? not (tem in we’ IL? |) then 
Been (350, 50) ; 
cae ptemp ier ae Sue ae 


ae pe ie tem 
ae "what S,yQur Tae amplitude? ’,1,11);3 
ee TY +7 er ee F1Q@); 
Input CN? Nees ata a code 


gee) 
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CS ae oe of 

e 

Mse(’What is your DC value?_’,1 13) 
In ut (ON? 79) 22), 15 jDpseiersr | biG), 
va answer ,Offset,code 
msZz( Hin 1s your Seca 2a ae 

1N’?,°1°9523,15,5,true,F1,F10); 
120 eee code); 


Be 
amas is oi, ee 


/sec 
vai oR se F1,F1@); 
ee CNT * Freq, 13 435 


end; 
end, je 6) or sGlesied (C \eloecpale on 7 Stel): 


repeat 
Tnput ( ? "A? , °C? ,40,17,2,true,F1 Eee 
temp := copy(ans er, 


if not (temp in 703 bc 4) then beep( 350,150); 
Until temp 1s. OC sage. 
if temp = ’C’ hen BiecuNooor = true 
else SaaS SOR: = false; 
ied rien your simulation time aoe the tae ea 
z max @);3 
ao 


t(°N?.,’? ,S5o2Ges true, FI ,F10)3 
val (answer Tmax, code 
ax > 99 ae n bee (pela 
er Tmax <= he and p Tmax > j : 


Boxuser 3; 
Blo ch... stg tae tal 


be 
ae an: to maxorder do CDenCoeff[{i] := 0.0: 
cit pigiize) 
For 1 ZeLZero 1 
rpbstbad (i 7 = NumoGere tid. 
. denominator equals he sum of open L@iop 
denominator and O.L. numerator 


for i:=1 to §S ae - do 
= ' cDenGoerf [i] + Dencoeff[i]; 


CDenCoeff 
if size > sizezero then CNpolés: size 
else CN oles:= SizeZero; 
{Nploes shold lees be greater,but to be safe) 

end 
else 
er ae 

Npoles: maces 

for sa 1 

ae Pon aee teste oDSeCCone It 
end; 


{ Calculation of new Amsmatras: 
fOr 2 1 to CNPoles-1 do 


.eee 
¢<=1 to CNPoles do 
ona 
if j = i+1 then Aris j 4s 1.@ 
else A * 0.0: 
end; 
end; 


Ue 
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{Calculation of new C matrix )} 


for j:= 1 to CNPoles do 

oe +B 

Be oles xd | >= ~CDenCoeff{[j]; 
for i:= 1 to CNPoles do 

begin 


if i >» SizeZero + 1 then elias ®.@ 
aes 


se C1 = NumCoeff[i]; 


en 
alt See ree = CNPoles then 
C1 if 7 = cilit + NumCoeff[SizeZero+1 ]* 


end; 


CNPoles,i]; 


{ Selection of sampling time interval )} 


mercr := 1000; 

res Tmax/Nincr ); 
Atemp :=A;3 

Psi 


>= A; {initialize psi to the Na uue of the 


infinite series after the first 


pealar Mult(Psi,T ea ee eee 


for i;= 1_to_CNPoles do wo terms I + A*T / 2!) 
Psifi,i]:=Psi il it + 1.0; 
BaeGeorial <= 2: T1-~ s= es Oldmaxrowsum:= @.0;3 
repeat 
an 
actorial := Factorial * el le leer 
Matrix Mult(A,ATemp,Phi,CNPoles); 


Scalar Mult 


end; 
until “Mal £( 8s! 
Matrix_Mult 


(phi is used at temp) 
Mtemp:=Phis {holding matrix .to laree array } 
Scalar Mult(Phi,(11/Factorial),Phi-c Poles)> 


for j:=1 to CNpoles do 
Bee 
or m:= 1 to CNpoles do 


pee ya P st 04 in] + Philj.m]; 
end; 


end; 

Maxrowsum:= @.0; 

computes maxrowsum as Beene of change in last) 
for j:= 1 to CNpoles do{series term to be added. } 


begin 
rowsum:= @.@; 
for m:=1 to CNPoles do 
rowsum:= rowsum + Psi[j,m]:writeln; 
if rowsum > maxrowsum then maxrowsum := rowsum; 


end; 
if (abs(maxrowsum-oldmaxrowsum)/maxrowsum)< 0.001 


then finished := false 
{quit when .1%change}) else finished := true; 


oldmaxrowsum := maxrowsum; 


psi ,T, Psi, CNPoles}; 
A,P$i,Phi,CNPoles 


e 
3 


Or. fis = to CNPeles_do 
Enea). 2 = Phi iil + 1.0; 

PoGeae=- |. CO CNPoles co 
Gamma[i] := Psili,CNPoles]; 


{single input system with vector: )} 


TT 
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(Ie , 00 0 0 - oie (as IOS | 
Plottime := @.0; PlotiIndex ae deta GL ele re 
for i:= 1 to CNPoles do Xoldlilsegerg: 
init. prev. state) 
Ymax := 9.0: Yninw selec. 
Boxuser ; 
for N to, Nimncrwcde 


= | 

sel {begin calculating next state and y} 
egin 
: {compute input at time Plottime)} 
C88 OF eae of 


: Uinput := Amplitude; 
*R’ : Uinput := Plottime * slope + offset; 
‘I’ : if plottime = 9 then Uinput >= )2anpaeede 
@lse Uinput := 0.0; 
‘We + Uinput <= Amplitude = tae * plottime); 


end; {case} 
ME Ve eee eh OT eee oO aene 
compute new states 
for i:=_1_to CNpoles_do 
Xnext[il]:= eel + Gamma[i]*Uinput; 


for i:= 1 to CNPoles do 


begin 
if abs(y) < 1.@E@7 then y:= ¥ + cy tid * Ae 
dj else y:= 1.@E07; max y limit 
end; 
if SizeZero = CNPoles then 


y:= y + . NumCoefflSizeZero+1] * Uinput; 
if y >» Ymax then Ymax:= jy; 
if < Ymin then Ymin;= jy; 
doy mod 5 = @ then {plot every 5th point} 


begin 
GraphArray 


Plotindex, 1 >= Plottime; 
GraphArrayLPlotindex,2] := i 
InputArrayL_LPlotindex, 1 = lottime; 
InputArray|Plotindex,2] := Uinput; 
oe s= Plotindex + : 

end; 

eee >= Plottime + T; Xold := Xnext; 
end; 
Ymax := 1.1 * Ymax; 
ini teraphic;: 
SelectWindow(1); 
ee Ge ee : 
drawtext(20,26,1,’°U’ ): 
drawbext( 20,452,111, a 
drawtext(20,38,1,’P’); 
drawtext(20,44,1,°U’): 
drawtext(20,50,1,’T’ ); 


drawtext(25@,195,1,’TIME(sec)’ ); 


NiceAxes(@,tmax,ymin,ymax,’’);: 
SelectuorlalWorlandea@ oy Sel dctWindow(Windosieeney 


DrawPolygon(Grapharray,1,-(P otindex-1),%0,90,0); 
NiceAxes(@,t aX ne eee JG 

SetLineStyle(1); dashed line for input signal) 
ee ae noutArray,1,- Pilotindeeen) 102-0): 
setLinesStyle BY; 
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repeat until keypressed; 

quit := false; 

repeat 
Graph ene aa. une! ee quit); 

7 calls print / itle menu) 

If DumpGraph then PrintGrap 

Macil quit; 

LeaveGraphic; 


Data; 


asecaen(plotfile, ’plot.com’ ); 
re-execution graphics menu program } 
oe oT ; 
end. 
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Program Nyquist: 
label 1; {label decleration for goto statement } 


Type to {graphics routines} 
Graphix.sy 
Kernel.sys 
Pe ee 
O on. 
eee 


Ut-mod@1.inc {I/O routines} 
Ut-mod@2.inc 
Ut-mod@3.inc 


Gra Men eee options menu} | 
Pletnydqs eee yquist plotting routine) 
Boxuser.inc 


Yt tien alien 


mmm, 
FAD FHA AGHHAGHH 
HHH RR HAHAH HH 


ary 4 ee oy bd: 344 of real; 
ary6 = array [|1..21j of integer; 
{ bTPolly nom. ies: ene, routine} 
I Rootfind.inc } Polynomial roots finder routine) 
var 
Code,I,Count,NumberDecades, 
StartDecade ndDecade,one $ Die 2 
f,Wo,Wi,DeltaW Gain : Real; 
plotarray1, PlotArray2, 
MagPhaseArray,FreqArray : PlotaArray; 
ZMagen, ZPhase, PMagn, PPhase, Phase : real; 
TempxX , TempY : real; 
temp ; Char; 
Openioop, Fickig : Veeo lean: 
Uh lI) MO a BAe eee ee : integer; 
encoect? ,NUuMeocre cdcmeo@c int Sain yi $ 
real ar Up Ole 2 Ree eae ole,realpartzero 
crealpartpole,imagpar zero,cimagpartpole: ary5s; 
Seany iss 
plotfile eater 
funew$ ion Log aeee sreal; 
noe computes the base-1@ logarithm of X} 
egin 
f X=0 then Log:=@. else 
ores] Tn) (LAC lOMe 
Ind; 
function Expon(Y,X:real):real; 
oe {computes Y raised to X power) 
egin 
jana *= Bep( xX * Cin(Y)))- 
end; 
begin 


oxuser; one: =1; 
Characteristic equation(A1A,size,Dencoeff ); 
for i-.1 to. siZerdo 
PSTfi,sizel:=B(i,1]; 
fOr. jj:=2 to sigemwde 


orm i+z1 to size do 
-=Ssize-jj+i; 


Kiel = cE 
PSI[ijj]:=Dencoeff[(kki] * B{i,1]; 


8@ 
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fers l2=| to "Size do 
ae —o* as 
engre cred) t=PSili.s] +A1ALi,1] * PSI[1,kk1]; 


end; 
end; 
aor i= (eo Size: do 


**fhumcoet tli] O20; 
j:=1 to size do 


Boe 
*ffumcoetf [i] : ="Numeoefrli| + PSILj;,i1)] * Cl1,ij]; 


end; 
mem L:=1 to size do 
begin 
m:=Ssize+i1-i 
at Nemeos rein <> @.@ then goto 1; 


en 

ileas Sizezeros: =m-1; 
Clrscr; 
TextColor(lightblue); 
writeln 


uist Plotting Parameters 
HHH) )s smenpavist, Plotting 


writeln( Joes SSSSSSSeSseeSeeeeeeeeeeee2eeeeeeeqqseqsese===’ ): 
PicBig:= false; 


Msg(’Open (0) or (C) Closed Loop Plot ?’,5,5); 


re at 
eA ees 45 , 5 ALsISTDy anon be 


temp O (angw i 
se all) then Beep( 950,350); 
until temp 


if Roet Seno d 
if temp = 6” £70" 576 ocadd Oop 
else OpenLoop 


true 
false; 


Msg(’Graph window (B) Big ce Fr Beiget your own 
= : 
repeat 


ie OA?) 60.7 2 ,true,F1,F10)% 
oe Plas OpénbGop een user selécts the open loop) 
m = ens 
if hot(temp” n j then beep( 350,150); 
until temp in 2 g3 
if (temp = ’B’ then opts = true 
else PicBig := false; 


ae meu (pzcbig) then 
be 
Misa( Input Hour, lgtted? 5,85. to be 
te 
Msat | Etc el Oia 0) 


Wl 


1, 100 
ae & oN, Bs 59.8, rue FTF di 

answer, Woe eae Wo is ene irst plotted freq) 
Msg(’Input number of decades go 135% want 


plotted?’, 
npout(’N’ Ts Omalicen cu bae:, Hvilies Pie 
ee: NumberDecades,code ); 
end 
else 
pager n 
:=0@.001; 
‘mmber Decades: =8; 
end; 
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root_finder (si zezenoo Nunc os \ ges Olean 
imagpartzero,one) ; 
root finder(size,Dencoeff,realpartpole, 

ima ame e. 


gain: =Numeoeff{sizezeros+1]; 

or i:=1 to sizezeros+1 do 

begin 
Numcoeff{il]l:= Numcoeff[{i]/gain; 


end; 
clrscr;Boxuser; 


f Ore — eee! a ees do CDenCoeffli] := 0-90; 
{initialize 
£ i:=1 to sizeZenece. 1 


or Oo 
Cheep esas _ Numcoetf{?] * gain; 
C.L. denominator equals tne sum of open leer 
denominator and O.L eee 


fOr. i:=1 CouS12Ze eee 
CDenCoeff{i] := CDenCoeff{i] +Dencoeff{i]; 


if Size >» SizeZeros then Cnpoles:=Size 
else CNPOLES: =SizeZeros; 
compute new denominator roots) 


root Pinder (Capollesmeneeeees: CRealPartPole, 
= CimagPartPole,one); 


StartDecade := ee Ou E 
compute linear scale to plot } 
kndDecade := StartDecade + NumberDecadeés; 
log numbers. Also figure step) 
Wf := Wo *_Expon(10.0,NumberDe BEIGE: 
De Expon (WE/WO).0,0125)5 
i a wior 


for sCount =a ¥9 81 do 
{do 81 iterations...arbitrary #) 
Begin 


ir ep enor oe ta 


{compute bode numbers if openloop and later if 
closed loop 
eae 
Magn:=1.90; ZGPhase:=0.90; ee: 
PMagn:=1.0;) PPhase:=0 0 : ama Cara aezee) 
Lor 1 := se S1iZzezer os ae 


{compute magn and phase of zeros for freq step) 


begin 
iene een * Saqrt(Sar Beal Panzano ale 
Sar(Wi-ImagPartZeroLI])); 
if RealPartZero[{I] =_@.9@ then 
ZPhase:=ZPhase+pi/2.@ else 
partzero{i] >» ®.® then 
S 


e:= ZPhase - ni_+ ArcTan((Wi- 
EMDyL ce artZero[i])) 


begin 
Tf 


ImagPartZer 
el 


se 
_— lies SS er tek CUR Wel 7 cea): 


end; 


hor iL i= 1 to Sigesdo 
eoupuue magn and phase of poles for freq step) 
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end 
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be 
ae =PMagn * wart (Sgr (Wie Imagbart gett ty) 


sar(Wi-ImagPar 
tots RealPartPole[il = hen = 
heen. PPhase+pi/2.@ else 


i pepe eo Chotert 4 > 0.0 then _ 
PPhase:=PPh + Arc 
_magPartPoteti})7(- Heat eaae OWiTtq)) 


PPhage:= ,PPhasetArotan( (Wire no1era])); 


end 
end; 
Phase := Frac((ZPhase - PPhase)/(2*pi)) * (2*pi); 
irveyehbultey ee 
Tem 


px gOS tae eae Beiritane seco Phase 
TempY : Se een Phase 
sleet (BicBig)” and X : 
Ph 


t ReMP 8 3 emp X 
lef icBig) and (TempY > 100) then Tempy 


rT: ase<@ the hase: Phase+(2* 
ie dGensce ole ) and "(Phase<(5*B1/3))) then 


emp xX; 
If ((Phase>pi) and MEEaeS< (oso ane then os 
ae empY := -TempyY ; 


il ue 
em om 


OQ; 
OO; 


pee nnes ena ay (Count 2 := Pha 

MagPhaseArray|{count, 1 $= Gain#*zMagn/Pmagn; 
plotarray| {Count 1 := TempX; 

PRotArraye!{ count, 1 s= Temp; 

et coe] := TempY; 

PEGtarraye|count,2 | := -TempY; 

FreqArray[Count,1i] := wi; 

Wi := Wi * Deltaw; {increment freq step) 


else 


{perform same steps as above if closed loop requested} 


De 
Bree =1.0;Z2Phase:=0.0;PMagn:=1.0;PPhase:=@.@; 


Ter = = i "to SizeZeros do 
ee 
Magn:=ZMagn * nat Sori" FaagPartZeroLty5) 


ImagPartZero 
slits RealPartZero[T] then 
ae ZPhase:=ZPhase+pi/2.@ else 
ee RealPartZerol[T] ee 2 the 
ZPhase:=ZPha = AroTan((Wi- 
ane ere a hes artZero[i])) 


se 
ZPhase:=ZPhase+Arct t 3 - . 
foarecctreror.t)) “Real PartZero[i})); 


el 
end; 
ela: 
a 1 = 1 to CNpoles do 
“BMa 
Magn:=PMagn * Sqrt(Sqr(CRealPartPo io 
- - on rt Wi iGimagPar tPoleLt 74332 
et CRealPartPoletl 
PPhase: En eee eae ®@ else 
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FILE: NYQUIST.PAS Program. Liciine Page 5 
begin 
if CRealPartPole[I] > @.@ then 
pena yarn - pi_+ ArcT (oy - 
SBE OLS i iy (eee eal Paonia )} 
else 


PPhase:=PPhase+A eran (was 
Dy, 


CImagPartPole (-CRealPartPole[li])); 
end; 
end; 
Phase := Frac((ZPhase - PPhase)/(2*pi)) * (2*pi); 
{Phase "modulo" 2Pi)} 

TempX := BS ie soaee baa *cos( Phase 5 
TempY := abs((Gain*ZMagn/PMagn )*sin( Phase) ); 
clei (PicBig and (TempxX »> hen TempX := 100; 
if (PicBig) and (TempY > 100) then TempY := 1909; 


If Phase<®@ the hase:= Phase+(2*pi ); 
Tio Bhese Cole and (Phase <(3*Bi/3) )) then 
empX:= -Temp”; 


If ((Phase>pi) and (Phase<e*p1 } eee 4 
emp 


>= -TempyY; 
EL otAnna) pe Oumar = TempX; 
Plotarray2 beoeunu..| = TempX; 
EL Ot ar ray ipo = TempY; 
PlotArray2d (count, 2 = -1.0 * TempY; 
Pe >= Wi * Deltaw; 


saya. = 
Plot _Nyquist(StartDecade,EndDecade, 
NumberDecades Ee a > Oe 
Plotarray2,MagPhaseArray, Pic ig,OpenLoop) ; 


Assign(Plotfile,’ 
Execute(plotfile) 


end. {Nyquist} 


Plotocom ). 
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Program Root Locus; 


This program plots the root locus of the plant 
label 1;{label declerations for the goto statement} 


$I popeees 87S} {graphics routines) 
I Graphix.sy 
i wernel.sys 
t Pee eae} 
O on. 
if ARIS hehye 
I Ut-mod@1.inc,} {1/0 routines) 
I Ut-mod@2.inc)} 
I Ut-mod@3.inc 
{$I GrapMenu.inc} {graph options menu} 
type 
ary4 = array pee id of real; 
a ary6 = array |1..21] of integer; 
ar 
ind ,COGe, LineCount : integer; 
PlotPole,PlotZero ; pee ctArray ; 
PlotRealPole,PlotImagPole wear yos > 
DeltaGain,StartGain, EndGain, 
Variable Gain, Xmin, Xmax, Ymin, Ymax,gain: Real ; 
Neg Feedback,dumpgraph,quit : Boolean; 
ies 7 vext >; 
jj ,kk1,m,1,sizezeros,one : integer ; 
holdpoly, dencoef? ,numcoeff >: ary4; 
realpartpole,imagpartpole,realpartzero, 
imagpartzero >: ary3s; 
; ably is;> 
plotfile s file; 


{ I Polynom.inc } 
I Rootfind.inc)} 


Procedure, PrintGraphData; 
dumps root locus data to printer} 


Begin 
Messe Graphic: Crrscr 


repeat 

pe uco} on (uh te); 

gZotox 0,10); 

write : *** PROGRAM OUTPUT OPTIONS *** Je 
ZOtox ¢ Deo. 

writein(’<P>. Printer Su Dy are 
Textcol r(yellow); otoxy(20 14); 

writeln(’ Check Your Printer! >): 
Textcolor(white); ee 2 ; 

writeln(’<F> List to File name mae 
£OtoOx th 0,16): 

write on the current drive J 
Zotox ¢ Ould ) sae . 
Mees 18 yet cian goiicy 

otox: stextcolor(ye : 
Sie "REO + kextos! ee eer 
read( kbd, ch ) Powel “fee or ‘Celi eee.) or 
c = O = — 
Cen = "p’) then 
begin 
oF Gche= °F’) or (ch = “f’) then 
begin 
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RLOCI.PAS Program Listing Page 2 
otoxy(24,15);textcolor(red); 
Sotoxy | Bh int in@ee cs ry; 
assien\) is tiene 
rewrite(list); 
end 
ee 
begin 
gZotoxy(24 13 ggextcolor(red); 
write(’?PRINTING........... >); 
assign) tae mlinst >?) 
rewrite(list); 
end; 
LineCount :;: 
writeln list 7 
ae eee lise ZEROS ’); 
writeln ny Lisp)s 
wrigetl st. a 
write List. REAL 
IMAGINARY? 
no Line Senus s= LineCount + 6; 
ee i := 1 to sizeZeros do 
2 
friteln(list,’ pee bene {3 TO 
ImagPartZero mie 3); 


LineCount := LineCount + 1; 
en 
Taste in list); wedteintlist): 
writeln( list POLES’ 
writeln list ' 
write 1 Site GAIN as 
write ee REAL 

IMAGINARY’ 5 


writeln(list); LineCount := LineCount + 7; 
Variable Gain := StartGain; 


{compute root locations for varying values of 
gain and print them) 


DeltaGain ie eS Se 
For J:= 1 t68S0eGe 


Be 
“fsldPoly := dencoeff; 


If Neg_ a eee then 
Kor 1: 1 sizeZeros+ 
Hol Poly [7 — fiolapoly Ta + 
gain*Variable _Gain numcoeff[T] ) 


nor olden prfers"Ro1 dF omen a 
O O = Ho O ai 
2 Variable * Gain j numsoerf(I]): 


Root de HoldPoly,PlotRealPole, 
tima Pole,one 
wri ues eoe Tsien le Gain: b: a; 


LineCount := LineCount + 1; 
for i t= 1 te sizer cao 
begin 
ra pean eee ee cee yA 
PlotRealPole([1]; aE 
,PlotimagPole[i 5 oe 
ad on ee eee := LineCount +F le 
weitein(1ist); Linecau ¢= LineCount + 1; 
LineCount > then 
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begin 
Wetceln( list, chr(12)); 
LineCount := @: 
era, 
enyat table_ gain:=variable gain+deltaGain; 
end; 
until Siete OQ? 2 a i 
EnterGraphic; 


swapscreen; 
close list); 


emied; 
Begin 
One;=1;{Root Locus Input handler driver} 
PLij:= *%5506N01001-010101’; 
Pi2l:= °'5508N01002-010103’; 
PLSJ:= °1512N00503-010101’; 
PL4):= °1513N00504-010103’; 
PI15):= °>1514N00505-010101’; 
PL6J:= *°1515NQ00506-010103’; 
Pieape= “Soar 7ACO2O7TO10101’ ; 
Cimgisicr ; eee oe 
writeln(’ *** RO LOCUS PLOTTING PARAMETERS HHH? )S 
TextColor( Yellow 
ee ae a cance en oe eesecececaccessnans? = 


writeln;writeln; writeln; 

TextColor(green 

TextColor nput STARTING value for the variable 
ain : 

writeln; = 

writeln(’ ties — value for the variable 


TextColor(#ellow 
writeln; writeln; 


writeln; TextColor(gr ae 
writeln(’X-Minimum: 


writeln( ’X-Maximum: °’ ° 
Writeln( ’Y-Minimum: °’);3 
writeln( ’Y-Maximum: ’): writeln; 


writeln(’ Positive or Negative Feedback? (P or N):’); 


Input_Handler(’ NOTRE EAD ) 
prompts for NEW inputs) 
writeln; writeln; 
writeln(? _ changes tO these (or Ns rs? 
F 


Yor N):’)3 
Enipait( ’ A’, a ot Ls 2 eee F 1 Ce 
cr Bswer 20M th tn "Handler(’ CQ107’,Escape); 
aon 5 weae changes 


ee ea StartGain code ) 
ts input strings into numeric values} 
Val(fiilvar ee 


,»EndGain,c 
Val(filvar 
Val(filvar 
Vaserilvar *Ymin, code 
Val(filvar ’Ymax, code 


EE asce@ eka | f |, 15 | <> 'N’ then 
py L7 J ‘ieo" feedback := false 
else Neg feedback := true; 


’Xmin, code 
’Xmax, code 


ANPUNO 


wevee woe we 


INITG CRAEYIC; ;{define values for graphics routine } 
iM CHa eS (xmin,xmax,ymin,ymax,’’ ); 
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haracteristic equation(A1A,size,dencoeff ); 
calculate dentoeff from the plant matrices} 
es is:=1 to size do ; 
calculate numcoeff from the given plant matrices} 
ea 
Sifi,size]==-Elieane 
end; 
for jj 22. tomsizevase 


eae 
or i:=1 to size do 


begin 1 ees 
2=size— > 
kk13;=j+ ie . 
PSI{ijj}J:=dencoeff[kk1] * B[i,1]; 
aos to size do 
= n 
PSI[i,j]:=PSI(i,j1] +A1A[i,l] * PSI[1,kk1]; 
ena; 
end; 
end; 


for il:=!1 to sizemde 


begin 
numecoett |i )<=0G- 
for j:=1 to size do 
begih | | a | 
numcoeff[i]:=numecoefflil] + PSI[j,iJ] * cl1,j]; 
end; 
Simei 
for 17 =letorswzZe sce 
begin 


m:=size+1-1; 
if numcoeff{m] <> @.9 then goto 1; 
end: 
Tisizezeros:>m-1 5 
Calculate the zeros of the system} 
root finder (sizezeros,numcoef ,realpartzZero, 
imagpartzero,one); 


gain:=numcoeff[sizezeros+1]; 
{convert highest degree numérator coefficient into 1.) 


for i:=1 to sizezeros+1 do 
numcoeffli]:=numcoeff[i]/gain; 


For I:=1 to sizeZGeros do 


Begin 
1 eas S= Rea Eaaeen er 
PlotZero_Ll,2] := ImagPartZerotIl]; 
ena, for} 
Case sizeZeros of 
‘ws Seas 
lotZerol2,1j:=PlotZerot1,iJj; 
PlotZerot2,2):=PlotZeroli,2]; 
PlotZerol3,1j:=PlotZerot1,iJj3 
PlotZero!3,2}:=PlotZeroi 1,2); 
NICHAXES (xmi a fe ea 
Bt aw Oe ae PlotZero,1,- , = ona ); 
end; 
22 oes 
LotZerot 3.) | aoe ee a eee 
PlotZero|l|3,2]:=PlotZerottl, : 
NICE SES caus xmax,ymin, maz,” } 
DrawPolygon PlotZero,1,-5,-3,3, ); 
end; 
else 
eee paee xm xmax,ymin,ymax,’’ ); 
DrawPolygon PlotZero,1,sizeZeros,-3,3,0); 
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end; {case} 


Variable Gain := StartGain; 
DeltaGain := (EndGain-StartGain)/5@; 
{divide gain to plot 5@ points} 


For 1 to 5@ 


A do 

x , {calculate and plot 5@ points per graph) 
BoldPoly := dencoeff; 

ae ee then 


For = Fe SsizeZeros+1 Oo 
HoMdPoly)i] := HoldPoly|[I] + 
(gain*Variable Gain * numcoeff{[I]) 


Hor L:= 1 o_.SizeZeros +1 _.d 
pomcnery i = Hema Poly za + 
ain *Variable Gain * numcoeff[I]); 
Root _Finder(size,HoldPoly,PlotRealPole, 
PlotimagPole. one): 


mor I:=1 to size do 
aes (Erlis plotting matrix with powes > 
egin 
EioaRoilic 1 = PlotRealPolelLI]; 
ae ire = PlotImagPole|I]j; 
end; 
AXisG1b := true; 
Case eS 
artificially Eta plotting array if fewer 
; than 3 points 
1 Pere 
Mephomet2 .liic=Rlotrole| 1, lis 
Preterole 2,2 )2.=Plothol eilMm.2 |; 
PIGtPOlelS. 1) :=PlotPole rr, i): 
Plotpe le) o;,2 |:=PlotPoele.|,, 2); 
NICEAXES(xmin, xmax, ymin, Ege a) 
DrawPolygon(PiotPole,1,~ 4.3 0On 
end; 
2 begin 
Deere te a Se oenet ens 42 
Wiemrole|5,2):=2PlotPol Nee j3 
NICEAXES( xmin, xmax ea) 
Pee iGe Woes s7 2,715,295 ); 
end; 
else 


NICEAXES( xmin, xmax ea eee 
Biaboly zon PlotPole,1,size,-1,3,@); 
end; {case}. 

eee ath var tabre_gara + Deltagain; 
end; 


Repeat until KeyPressed; 
quit := false; 
repeat 
Graph Menu(’Root Toco paper apn gut E); 
. calls print/title menu 
If DumpGraph then § PrintGraphData; 
Mae tL equi tv ; 
eee eDn 1G: 
Assign Ot fi hex.’ p 
Exe Ute(plotrité); 
end. {root _locus 


lot.com’); {re-execute plot.com) 


So 


FELE: ROOTS. PAS Program Listing Page 1 


Program R 


(39 bel les Cisse decleration for goto statement) 
$I Typedef.sys) 


TYPE 
ary4 array 4 - 4 of real; 
ary6é 


array (lee om integer; 
var 


posCounter ,i,j,jj,kk1, oh 1 

cnpoles sizezeros,one: nteger ; 
dencoeff,numcoeff, SHone See Ee: ary4; 
realpartzero, ,imagpartzero 

oe partpole, cimagpartpole ; ary35s; 


aryls; 
So tere Se Tednelcens en 
Zain :real; 


I Polynom.inc} 
I Rootfind.inc)} 


BEGIN 
Cirscr: onesie 
Characteristic sequation(AtA, size,Dencoeff ); 
for i: ize 
Pstfi, Pet oan. Sein J: 


i Gis JJ: =2 to size do 


ee 
or i: to size do 
begin — 
ees Jj+15 
psrtg3])! =Dencoeff[kk1] * B[Li,1]; 
ion to size do 
S 
S81 [1,3] :=PSI[i,J] +A1A[i,1] * PSI[1,kk1]; 
end; 
end; 


end; 
aoe i:=T to size=de 


*°ffumcoef fli] : =0.0; 
for 327=1 3 e size do 


be 
fuimcoefz [i] :=Numcoeff[1] + PSI{j,i}] * c{li,3j]; 
end 
end; 
for i:=1 to size do 
begin 
m:=sizet+i-i 
= numeoeff(m] <> @.0 then goto 1; 
en 
bee sizezeros: =m-1;3 


root _finder(sizezeros, Ee Oe gee Pen 
imagpartzero,one 


ain:= Numcoeff[sizezerost1 ]; 
on i:=1 to sizezeros+l Oo 


ffumcoet# [1] : = Numcoeff[i]/gain; 


end 
for i:=1 to maxo der do 

CDenCoeff i] s= 0.0; ea 
for i*41 tos eros + 1 

CDenCoeff es = neo rl * gain; 
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FILE: ROOTS.PAS oe iistine Page 2 


for ri an ~ 
cbéncot Se = épgncoeff[il + Dencoeff [i]; 


f Size > SizeZeros then CNPOLES:=S 
(NPoles Should always be * 28 


else CNPOLES : ©S1zeZeros: 


{compute new denominator roots 
root_finder(Cnpoles, sCbenGoeft ce ee 
ImagPartPole, one 


Cilascr > fextcolor(lightblue); a screen _ titles) 
writeln(’ Eons rae! .. Characteristic Equation 


writeln: writeln: 
writeln(’ROOTS B bo t B VASMSRATOR: »)s 


For I:=1 to SizeZeros do {position for output) 


be 
BosCounter := (I mod 2) 
PosCounter = 1 then eee 
LowVi write zer é 
write "sf? 4 = eae RAGaC Nene oe 
' TmagPartgeroti 210: ; 
write(’ 
end; 
Wiel Feln: 


rate ln: cies 
W@itoin( RO OOTS OF TH DENOMENATOR: >); 


For oe =1 to CNPoles do 
Bas compute oa creen position) 
Poe eer $= I mod 25's 
PosCounter = 1 aae writeln: 


. . SUtDUL re ts ; 
wrsvet al F:cdagebAGRRBLEFT GeEDh o> 


end:({for)} 


LowVideo; 


HighVideo;gotoxy(1, 
Waite press any ik key v4 continue or [Shift] [{PrtSc] 
mom Nardcopy .« 


{check keyboard eee for value change 
If number changes Pe or 2 indicates that shift, key 
depressed. If so, then remove "Press any ney 
prompt from screen so it won’t print to prin Sei 
keyold := mem[0000:1047]; not_erased := true; 
Swe 
= mem[ 2000: UC EaGe: 
fey ( ( (Fes =keyold + 1) or (key=keyold + 2)) and 
not_erased) then 


begi 
Eetorr( 1. 2A wri Get S00) 
Oe _erased = talkse; 


Until ee eee oor 


Assign( ie ee erasin’ 3} S 
Bxecute(plotfile 


end. {Program penta’ 
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Program Matrix _Manipulation(input,output ); 


$I Typedef.SYS) 
$1 Box. INC} 
I Ut-mod@1.INC} 
var 
help3file,inversefile,determinfile, 
Polynomfile,eigenfile :file; 
Procedure Matrix_mathematics_ menu; 
var 
i,Tab : eee 
Okchoice : Set Of Char ; 
Finished : Boolean; 


Procedure MenulItem(Pick:Char;Description :Str8@; 
Polcrehtoes: 


nee 
“ARERSOLO® (oener 


Write ‘tale (?)s; extColor(white); Write(pick); 
= ae or(color); WET ete CGN ea B 
nda; 
Begin 
rScr; TextColor(white); Finished := False; 
GoToXx (19,4); 
Write(’*** MATRIX MATHEMAT TGS MENU ***’); 
Hany al = 1 to 4 do WreteIn@ 
a = ; 
Menultem 3D”, ‘Determinant of A Matrix’ ,yellow); 
Menultem(’C’,’Characteristic polynomial of A 
Matrix’,yellow); . 
Menul een 3.) eee of A Matrix? ,yellow); 
Menultem(’E’,’Eigenvalues of A Matrix’ ,yellow); 
wie lewd ; 
Writeln; 
fenu Tena eee lightmagenta) ; 
Menultem(’Q’,’Quit to SVS Main menu >, lightmagenta); 
TextColor (green) 3 
Ox; Writein; 
eset ote Gate: GoToXY (40,22); 
epeat 
OP tons 


until ch in [°D,°C°o7) [ea eee 
Se ao 
: n 
Assig eer , determin -chn) > 
crear eterminfile); 
‘Tis gees 
: n 
eeiie 
Chain 
Cds ceeaihn 
Rssig eo ~ Polynemeehn’ )7; 
Chane oly once 
=’: Son 
ais egin 
Rssig (eigenfile,’eigen.chn’ ); 
Ca eigenfile); 
end; 


2 Ae begin 


ssi help3File,’help3.CHN’ ); 
GhainthelpsFile : o 


(inversefile,’inverse.chn’ ); 
(invesse aie ; 


en 


One 
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FILE: MATRIX. PAS Program Listing 


Ose be ain 
ssign(SysFile, yeu woe COM ): 
Execute(SvsFile); 
end; 
End: {case} 
End 3 
Begin {main program) 
Irscr; 
nepes? 


2 
“Matrix _Mathematics_ Menu; 


Unt il "Finished = True; 
End.{main program) 


ee 


FILE: DETERMIN. PAS Program listdmae Page 1 


Program Matrix _Determinant(in 1b ; Olib nee) 
label 10;label— 20; ;label 30;label 40; abe | SORE enmetear 
label 7@;label 


S 

Re Ar on oe 

31 =n Hd) 
i Bee. NC} 


var 
matrixfile :file; 
list >text; 
Coun cer, i, jl ii,k,m,n,even sinteger ; 
temp va ue value ,»det,det correction, 
determinant oa determinant * neal 
Al saryls; 
Begin 
e@ounter <= Os: 
Boxuser ; 
for a ={ to size do 


Be 
ee 12 = 1 to si Zeno 


Bee 1 
iN i jd = "AT ALi age 
n 
gee a: 1 to size do 
Be in. 


30 ff: ,AILk, i] <> @.@ then goto 19; 


if’ ¢ ee Size) <= @.0 Chen scotowou, 

O 

1Q:3 if -K) >» @.@ then goto 40; 
(i- Kk) - @ then ZOmOm oO: 

fou a = coe size do 


en ears oar e ,m]; 
Abas mJ :=Ai tk, eee 


He ate: counter+1; 
TO eae es 

ieee i> size Liew OvOmace 
Boo a: =ii to size do 


Cet (Ai Lm, oe n g Ne 80; 
yalue:=A De ree, 
Lom. = 


Be 
E Si itm, sal pee n] - Aifi,n] * value; 
nd 


far i:= "to size do 


Begin 
: det:=det * A1(i.il: 
Mics 
det correction:= eee counter * PNG! 2): 
detérminant Bl dee correction eu: 
even:= counter mod 
if even <> @ then aoe ; 
determinant := See Or =O ba 
Veto SU; 
60:determinant:=—-determinant Sola: 
gZoto BO - 
40:determinant:=90. Or 
50:clrscr;writeln: TextColor(yellow); 
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Writeln(’The given matrix is : ’); writeln; 


worm 1s= 1° FO size do 
pei 7D 
See --= | FO size do 


rite(’ ’°,A1A[i,j]:11): 
EnGaywriteln; 

Bnd ;Writeln;Writeln; 

ree oe Gb? determinant value is :’); 

TextColor(white);writeln(determinant ); 


keyread(key,keyold,not_ erased); 


Page 2 


a 


Peo bi nctersrOtLOxmy( 5S,15):textcolor(yellow): 
writel (PRD POEMIN BES"? 3} ‘y ! 
Zotoxy 25 Jiri te (le 
Botoxy BiG 47)). 
eee Daehn ) ; 
alt Gh=’F’)’ or (ch=’f’) or (ch=’P’) or (ch=’p’) 

then sbeein 
ae (ch="P° ) or (ch=’f’) then 
egin 
= gotoxy (45,15); textcolor(red : 
McC Per UN TAPING. 2. 65 6 3 3 ; 
> PRINTI 
Assign(list,’Determin.RES’ ); 
Rewrite list); 
end; 
if (ch=’P’) or (ch=’p’) then 
begin 
pennies) Pex teeter (rer: 
Baete( PRINTING. ....... ; 
Asccien(izst, Est: )s 
Rewrite(list); 


end; 
writeln(list,’ 


"RESULT  ’»); 
writeln(list); 
writeln(list,’The given matrix is:’); 
Vee e ln list); 


Mee ts=! to size do 


py . 
Orie Stor s 1 Zeedo 

begin . 

err ewiiusiten’ .o,ATALd, j jet); 

Siar writeln( list )> 
emigewrd vein ie = ae tepeaniGlnis + : 
Wieecctildasct, che devermmant vaillic is 
writeln(list,determinant ); 
writelin list );writeln list); 
close(list); 


end; 
Until ch in [’Q’,’q’]: 


Aseiem(matrixfile,’matrix.com’ ); 
Execute(matrixfile); 


End. 


a2 


DETERMINANT 


as 
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Program Matrix inverse(input,output); 
I ee ee 
I Ut-moddi. INC) 

br Boxuser.ine 


ary4 = array plea of real; 
= array {1..21 of integer; 


Matrixfiile fae; 

list sbexG, 
Roa nc oct sary4 
inversé caryil 
Singular ,step,Stepper =: 


(31 TRvSree:ine} 


nteger; 


begin 
Girscr; Boxuser; singular:=0; | 
characteristic equation A1A,size,Polynom coeff); 


aver se 22 nG mate Ce On Or eee {ae eer Laas 
Pe ynom_coeff,singular ); 
eer oR Cone ae Ow; 


writeln he given matrix is: ’); writeln; 
for step:=1 to size do 
"eee : 
or stepper:=1 to size do 
begin 
write(’ ’,A1A[step,stepper]:11); 
end wre Le in, 
yg hele ie al wie: la) 
if singular=1 then . 
Waid irl Geer matrix is singular.’ ) 
elice 
begin 


writeln(’The inverted matrix is: );wrigeia 
for step:=1 to size do 


eRe 
or stepper:=1 to size do 
begin 
write(’ ’,Ainverse[step,stepper]:1@,’ >): 
end;writeln; 
end; 
end; 


keyread(key,keyold,not_erased); 


Repeat 
ox pri ter ,eotoxy (58, | );textco or ty llow); 
Wie n(’ "INVERSE; RES’ ); #cowoxy( 1, re 
wr e(? > 
otoxy(49,17); 
read kbd eS q} 
if (ch=’F’)’ or (ch=’f’) or (ch=’P’) or (ch=’p’ ) 
then begin 
ft (oh="F" ) or (ch=’f’) then 
begin 
gotoxy(45 peg ec OL on Cried) 
writet PRUNE TON Gioia captuavaioiat >); 
Assign }ist >Inverse.RES’ ); 
Rewrite(list); 
end; 
ifs(chee@P’?) ocre(ch= pp’) ten 
begin 
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ZOtOX: i Se tap, uextcolor (red); 

write TEN Gee. ate ane 
Assign ( RINTING. « >): 

Rewrite(list); 


enc. 
writeln(list,’ MATRIX INVERSE 
RESULT ZB) 
writeln list); 
writeln(list,’The given matrix is: ae 
writeln eo 
sex step: © size do 
be 
for s Seo per: = (Ge Ss 1 Z Cage 
egi 
eee (lis Wie ESC), stepper]:11); 
end;write Li 
as swriteln a(List, PP list). 
egin 
wrdtein( dist ’ The inverted matrix is:’); 
writeln( list 
Lou step: 6 size do 
be 
for Sstepper:=1 to size do 
begin 
We et oe i ie . ) 
inverseLstep,stepper ‘ 
Apes een versél ae a 


Ac 


Gaeta Miolci)s Wr bem ) 5 
close list); 


end; 
Until ch in [’Q’,’q’]; 


Assi 2en(matrixfile, ’matrix.com’ ); 
Execute(matrixfile 


end. 


oe 


FILE: EIGEN. PAS Pregram Listine Page 1 


Program Matrix Manipulation(input,output ); 
fon tye das Sue 
($I Ut-mod@1.INC}){$I Boxuser.inc} 


Gepe 
ary4 = array L1..11/) ef rea 
ary)5 = array [1..21) of weak, 
ary6 =“array [L1..21) of integer: 
var 
Macrixt i lems le. 
Pes stext; 
G2, Cl sary4; 
RealPart,ImaginaryPart:ary5s; 
Le, One sinteger ; 


I Polynom.inc} 
i RoeGurind + ine. 


begin 
clrscr; Boxuser;ene.— a, 
characteristic equation(A1A,size,C1); 


root Ender (8 ie ee Part, ImaginaryPart,one); 
ye ° 


clrscr;Textcolor low 
writeln(’The given matrix is:’);writeln; 
or i:=1 to size do 
(eae 
or j:=1 to size do 
begin 
write(’ » , Al A iesiellasatinlee 


end;writeln; 





end;writeln;writeln; 
writeln(’The eigenvalues of the matrix are: ’);3 
writeln(’ REAL PART 
IMAGINARY PART’ ); 
fore: =1 to size ade 
begin 
write(’ a 
write(RealPart[i]:3); 
write(’ + } : 
write ImaginaryPart[i]:3):writeln; 
end; 
keyread(key,keyold,not_ erased); 
Repeat 
6x pri ter pectouy( 8.15)3;textcolor(yellow); 
eee »UETGEN.R nays eotoxy (1,25 ; , 
wr e(’ wes 
gotoxy (49 21) 
eee Dac ; 
ch=’F’)’or (ch=’f’) or (ch=’P’) or (ch=’p’ ) 
then begin 
if (ch="F° ) or (ch=’f’) then 
begin 
gZotoxy( 45 Ad geextcolor (red); 
are PRINTING........., >); 
pects St ’'higen.RES’ ); 
HT oe list); 
end; 
if (ch=’P’) or (ch=’p’) then 
begin 
gZotoxy( 45 Ade gextcolor (red); 
Tite. BRaNiinie se >); 
Ass en(yist 'LST:? ); 
Rewrite(list); 
end; 
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wreaeceln( list,’ EIGENVALUES 


RESULT =) 
writeln list); 
writein(list,.’The given matrix is:’ ); 
wreiGtelma, List ); 
for oe to size do 


Peeen j 
s=| to size do 
begin 
write(lis es jjJ:11); 
end; Meter 
end;writeln (dist) ePencla st). 
writeln(l List, 
The eigenvalues Of the matrix are: 


writeln(list REAL DAR 
"IMAGINARY PART’); 
for ;=!1 to size do 
begin 
write(li vas 
write list, -RealPart(1]: 10); 
write tb 
write 13831 Imaginary ary oa: on 
Be Se 


writeln(li ee sax’ 
wr cte}n( list 


nd; 
Geet 1 Soin; bok, YP, °p’,°.Q%, qi; 


Aes@emematrixfile, ’matrix.com’ ); 
Execute(matrixfile); 


end. 
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FILE: POLYNOM. PAS Program Listing Page 1 


(ST°hyp Matrix Characteristic Hauation( inputyecureane.. 

bypeder. sae a 
mod@i. } 
eT Boxuser. ine 

type 
ary4 = array ae of real; 
ary6é = array [1..21] of integer; 

var 


matrixfile :file; 
ist ‘text; 


i,j,vertpos ,noriZpoeseeesceunter fae : 
exponent atric 


{$I Polynom.inc} 


begin 
Clrscr; pO uee TS 
Shera See eae tage Alas sokzeuCl);clrsem 
Textcol (vel WG duGelenn, 
etietar 5 ai en matrix is : '’)Jswritein: 
for - to size do 
veeen ; 
as j:=1 to size do 
e TA 
gin, SALA ieee oie: 


end;writeln 
end;wri eln; eee 
writeln(’The on polynomial of given 
matrix, 1S: ; 
VErGPOS-—ol2zer 7, 
or i:=size+1 downto 1 do 
begin 
jJ:=sizet+l—-i 
pose cunT en ee mod 4) +1;horizpos:=poscounter * 14; 


if poscounter = 1 then vertpos:=vertpos+t2; 
alia i <> 1 es al 


Seg ar bets 10, a Gerepos || write(Cci[i]: Tae 


msg horizpos,ver pos) 
StrP(i-1:2,exponent 
msZ exponent horizpos+1, vertpos-1); 
en 
else 


begin | 
gotoxY(horizpos-10,vertpos);write(C1lij:7:4); 
end; 
end; 


keyread( key ,keyold,not_erased) ; 


"epee ot ‘ Bab) tee elem teimenae 
ox printer:;:Zo Oo extcolor(yellow 
erie ae i DOTYN iy RES i - 
gotoxy( 25 fees is 
ZOtO y 49,7 ys 
rea iG Decl), 
i ch=’F’)’or (ch=’f’) or (ch=’P’) or (ch=’p’) 
then begin 
se en='’F’* “or (ch="2£° ) Sthen 
egin 
Botoxy (45 Lp eeee On cn ana 
cen PRUNT [vem . . ote >); 
Pent Se >Polynom.RES’ ); 
Rewrite(list): 


10@ 


I’ Tiske: 


PODYN@M. PAS Program Listing Page 2 


Sart }ch="P’ ) or (ch=’p’) then 


OLox ;textcolor(red 
Eee ($8 Hethée Bilt. ss ( di eye 
Assign( fst, TES: ) > 
Rewrite lives 


en 
EEL edn 1 Lene POLYNOMIAL 


RESULT za) 
writeln(list); 
writeln(list,’The given matrix is:’); 
writein ies t ); 

for ds to size do 


be 
a :=1 to size do 
pee ak 
Grite(lis ,AIALi, Teall es 


end;write 
end;writeln (lise. ;writeln(list); 
windpet list, The characteristi “polynomial Of 
given _ matrix is: 
i C Descending power of S ) ’); 
writeln( list 
oe = i:=size+ 
= 


wrgtein(tist 
); downto 1 do 


beiecie Sip i |: 4,’ - 
str Ss Veouent \. 


writeyn(14 t);writeln(list); 
close LER 


nd; 
aeeueaial cnn Oo. GJ: 


Assign( ee ee oe com’ ); 
Execute(matrixfile 


end. 
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Program Bono ee ee 

{$I Typedef.SYS es 
Program type and Variable eos ees 

{$I Ut-mod@1.INC)} {input utility programs 


type 

NS Aryl = Array[1..11,1..11] of real; 

var 
Sstepping,Steps,step,steppings, 
Temp |) Lene aie ee nmp lus. 
last _rank,k,valuelplus,kplus soleil Soe lee, 
new Matrix!1,new ma rix2 saryls; 
big’ matrix 7 sary |; 
list 7 wesc; 


i COO ney, {finds controllability result} 
iL weexuser .inc 


egin 
Valuel := 1; valyelplus:= valuel; 
Ciitescer: extcolor( ellow); 
Writeln(’The A matrix is : ’);writeln; 
For steps := 1 te size do 
eae 
or stepping := 1 to size do 
eee 
rite(’ ’,A1A[steps,stepping]:11); 


Brice ea wic tie 1; 
ENG Writer as Whe ue, 


Writeln(’The B Matrix is : ’):writeln; 
For steps := 1 to SIZE do 
Begin 
or stepping:=1 to ni do 
Saar 
rite(’ ’, BL[steps,stepping]:11); 


end;writeln; 
End; wrive ln; weicte la. 
For steps:=1 to size do 


eee 
eee) oe 7= | ewido 
egin 
new matrix2[steps,stepping] := B[steps,stepping]; 


new matrixi[steps,stepping] := B[steps,stepping]; 


End; 
End; mplus: 
For steps 
Begin | oe 
matrix multiplication(A1A,new_ matrix! 
new matrix! ,size,sizé value2); 


size-1; value2:=valuel; 
1 to mplus do 


step := valuel +1; valuei := valuei + value2; 
For k := 1 to size do 
beeen 
or stepping := step to valuel do 
Begin 


Steppings := stepping-stept!; 
new matrix2[k,stepping]:= 
= new matrix1[k,steppings]; 


End; 
End; 
End; 
For steps :=1 to size do 
mo FS 
or stepping:=1 to valuel do 
Begin 


ig matrix[steps,stepping] 
new_matriz2[steps, stepping]; $ 
na, 
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FILE: CONTROL. PAS Programas tine 


mods emp lus :=1 
Lee steps :=1' to size do 


Page 2 


Be 
fiatrix_reduction(big matrix,mplus,size,last_rank); 
pay us T= last_rank +1; 


if ae rank = size then 


Writeln(’The system is controllable. °);Writeln; 
ime last r os < size then 


Writeln— : Seco is uncontrollable. »>)Ys;sWriteln; 
UREVOLD: NOT ERASED) ; 

in On Om oc. ;textcolor(yellow); 

Ee NTROL TRES* 3)3 Cy di 

7 swrite( ZR 

h ) 

) 

i. 


Bece— ie Gio Chi="p?)) or s(Cen=P” ) 
or (ech=. +t then 


tNbING eer oe 
oe 


e 
NG... .aauees ys 
es : 


CONTROLLABILITY 


RESULT ee 
Weateln( list 


aan the Plant Mmatrixea- 1s <=). 
writeln( lis \; 


SS steps := 1 to size do 
e 
For Stepping: = | 2O size do 
Be 
PELLET ia) ,A1A(steps, stepping ]:11); 
End j Wri et) {WPi teln(1ist); 
(fist. The input Matrix Bis: ’); 
reer Tiree 
oe steps := 1 to SIZE do 
e 
For cu ne =) betel nr do 


Begin 

rite(list, »BLsteps, stepping]:11); 
End;write 

Eads Writeln( n( di Ey eee ee C Ite): 


last rank = size then 
Wee ecin( list, The system is controllable. ’); 
Wire Celn; 
If last rank < size then 
Weitelns Glist,... Thewsystem is uncontrollable,” ): 
Pedi 
eiose(hia 3P swriteln(list); 
lose( list 


En 
een "Ch in [’Q de 
Assign(SvsFi eae. OM’); 
5 eee Sie ): 
n 
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FILE: OBSBER. PAS Program Listing Page 1 
Program See ete t input 29 2c Oe 


label 1;label abe abel 
{$I ee {program type and definitions} 
type 
Me Aryl = Array[(1ls.11,1..10)) Otenecam: 
a t it t its 1 a6 on, 
stepping,steps,ste em em 
S deo: Faluee fast tank a cs integer ; 
matrix : aryis; 
matrix matrix 2 Wars yl; 
list : text; 
I Boxuser.inc 
i Control] inc oe 
I Ut-mod@1.inc}) (utility input routins) 
Ses 
Te Sers Textcolor( yellow); 
Writeln(’The Plant matrix A is: ’);writeln; 
ce ae steps := 1 to size do 
e 
Fors a ae >= 1 to size do 
e 
Write)’ »A1A[steps,stepping]:11); 


nd; evade: renee 
The output Matrix C is : ’°):writeln; 
Bos stepping := 1 to no do 


be 
for steps:=1 to size do 
egin 
= Writet ’ ’,C[stepping,steps]:11); 
one sw i tesne 
en 


writeln;: swriteln; 
add no: =n0} value2 :=1; 
ho steps: 1 to no do 


Be 
for AowePP Bee =1 to size do 


“eae matrix[steps aeons g] = 
Steps oe al; 

matrix[steps, stabeine éTste eps,stepping]; 

na; 
Bnd}; 
4:matrix _reduction(matrix_matrix, dd AO; 
size,last rank 
{calculate the rank oF ne matrix) 
If last rank < size -thenmGeto, 2. 
Writeln(’The system is opservable with inGc x 


e2 ee );Writeln;: 
a KBYOLD,NOT _BRASBDYS 
ise; aval an 9 oe ee GoTo 3; 
is unobservable. ee 
PETEBB, KEY, > KEY PBS “NOT ~ ERASED) 3 
Writeln; 
3° ee S = Bee linacesis: 


size size 


matrix “muitiplication(matrix, AlA,matrix,no, 
ey ee and C matrices pF 


For steps 

Begin 
Step:= last_rank + steps; 
for stepping:=1 to size do 
Begin 
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FILE: 


OBSER. PAS Program Listing Page 2 


matrix Gee Aner ie etece stopping: 


matrix 
End > 
Enid: 
add no := last rank + no; 
GoTo 4; cos 
Veep | ite atc oe i al ); 
Ox rece r ?2Ot Osx ;Lextco SE e OW 
writeln( ' "Ob ER. EESRS 3 edtoxy( 1, BSys 
write(’? eS 
CE OsE A G9 AT) 
et bd oh . 
If (ch=’P’) or Gol p? ) orf (ch="F° 7 or (ch="f° ) 
then oa 
Pamcen="'b") or (ch='’f") then 


Se 
OotoXY(45,15);textcolor(red); 
writel BRE nets IG eel Stel rence 8: << ae 
Assign( jst, obser RE See 
print observability output } 
Rewrite(list);{to file on the current drive) 


Bnd; 
bie (chs weeeor (ch=’p” ) then 

egin 

Zot oxy | 5 ae ,rextcolor (red); 

write ING, ......... >); 

oo ae hen is 
{pEeint.o rvability result to the printer) 

ngowrteettist 
iecain( list, OBSERVABILITY RESULT ae: 
Wimitein( list); ;Writeln(list 
Writeln(list,’The Plant matrix A is alae 
writeln list); 
eae ee := 1 to size do 

Be 

For stepping := 1 to size do 

Be 
Neto (ds aera: stepping]:11); 

End 3 ‘itein( Hi 
End;:Writeln n{ List) ‘Writeln(list)s 
writein( {i St, lee Output Matrix (mis < ”); 
writeln list); 


a Steps: GO no: ado 


be 
for stepping:=1 to size do 
nee iecces” stepping]:11); 


end write 
end; Writeln tetteee, ‘Writeln(list); 


last rank = size then 
modeeoin( list, ‘The system _is observable with 
index ’,valvuecd,’ 
If (value2 >= size ) and last ari < Size), then 
Writeln (list,’The system s unobservable. '); 
write ‘writeln ees 


ce 
Close Hse 


End ; 
Uncil @h im f'Q',’aq’ ]; 
Assign(SvsFile,’svs.COM’ 


ime Co. cute SVS main program} 


Execute(SvsFile 
nad. 
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FILE: LUBNBERG. PAS PRoeram. Listimac Page 1 


ram Luenberg observer(input,output 
($0 et epeder. SYS }7— (AnD Bowe 


{ i eos Cees 
I Ut-mod@2.inc 


label 94@;label 96@;label 22;label 28; label 9590; 


Type 
aryl = array [1..1@] of real: 
arye2 = array Wire. cee. . 50 of real; 
ary) = array L1..3@0] of real; 
ary4 = arraywie. |1) of real 
7 ary6 = array [1..11} of integer; 
ar 
rae es 000,0000 -real ; 
i,NRI, ,mm, arm nrp,1xx,jxx,s, one, 
mrn,nr, oe Ie wat 


; OF umran,ii, rod 

code yy a eneeece ond oneer poscoun 
a 

geri, coef,desired feedback 


beta,x 

Plait 

ist 
strg,exponent 
change 
Specification 


Realpartvalue,imaginarypartvalue 
temp, inputtype 


’ 
er 


eo) 


LJ 
we 


OPNCNGPPPPPH 
~(Q MU 

Ube ND 

=) 


{$I Ut-mod@3.inc} 
{$I Luenberg.inc) 
{sr Pole.inc)} 


I Rootfind.inc } 
I boseeen ino 


Be 
Girser ; luen:=true;one:=1;3 
for i= to size do 


FBress <ESC> to change it!, >); 
nh th <ENTER> key '’); 
bserver Design 


e your ae ut w 
ona htblu oy: 
wes erger 


zotoxy 
write 


; 
2 
ct 
ee 
eS x 
x 
x 


EY 


msz input ee of observer ( 1@ max)’ ,1,5); 
epeat 

impit (NJ. ; ,3,true,F1,F10); 

va answer ix éod 

tie (| Peep 05 1 then beep( 900,350); 
wumtil (Cr avy on > a} : 


rps=rt+ 
eae >Input the Desired Feedb ck Coefficients in 
Factored <F> Form 


msg(’ or coéfticient <Co= Horm °°, 1,con 
re 

Peas put(' ae ,64, T 2 arr »F1,F10)3 

temp : Seon Can Tee os] 


1@6 


FILE: LUENBERG. PAS PRost amends tine Page 2 


Zeno. ( tempeckn Tete? then beep( 900,350 
until temp irae Ey: J) et Ms 


inputtype: ie 
Case inputtype of 
oe Tae ee 


cf change Diem 
hOket >= sue, Size do 
begin 
Ee eet 2 Pilvar[2*i+9]); 
str(imaginarypartva gee i138 
eae i yan [ome 
e 


input _Factored(’ POLES’ ,size,RealPartvalue 
Imaginary Partvalue 


end, 
ae :begin 
if change then 
tol a 1 to size-tl do 
begin 
str(Desired_feedback[size-1-i]:8 
5 Fil foe (Sieaiee= tal 
en 


enqnPut coef(’ POLES’ ,size-1,Desired feedback); 
end; cirs r;Writeln; Soo ie eee) 


invvid o 3 ess <ESC> to change it!, es 
ZOtoxy 
invvid iG then Eyes your ghebt th <ENTER> key ’); 
Bros G 3 Tex olor (ligh LUGE 
rite Luenb enger Observer Design 


nput Parameters %% * 
textcolor(yellow 
writel coe SSrrrttrtrtttrtrttrtrsttrtttttsttstttttetesteststsesesese=a’ yee 


Bees gor ereen) s 
msg(’Input observer characteristi Fae 
Factored (F) F rm ’,1 55) 
msg ee or Coefficient (ESF Form ’,1,6);3 
repea 
atc: peewee? ~65 , 5, 7. Thy Sort sr tO); 


Gem answ r 
it aon goba tat eh 31) then beep(900,350); 


until temp [oF Crd: 
if temp = Ge Mone ZO Oo 950; 


ot change then 
ao i— I FLO: do 
egin 
= Se ee eee uel |) ee 2 Filvar[e*i ed) 
ap str(imaginarypartva erie 1:8 Ee i+10]); 
en 


input mpactored( * POLNs 2 hy Eee eeaey ee: 
ImaginaryPartvalue 


Polynomial of _roots(r,Realpartvalue, 
Imaginarypartvalue,coef); GoTo 960; 


950:if change then 
MOGs = | tO r do 
begin 
- str(coef[r-i]:8:2,Filvar[r+22-i]); 
end; 


iam. Coert(’ POLES’ ,r,coef ); 


BoOeouenimder(r,coet ,realpartvalue, 
imaginarypartvalue,one); 
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FILE: LUBNBERG. PAS 


Procramn eG st ine 


ClrScr:Writeln;:Writeln; 


Writeln The observer eigenvalues aricwe: ms 
PART IMAGINARY PART’); 


writelin REAL 
{Or a Ietosr do 


Be 
Gite: ’,realpartyalue[i]:1@, 
lnagiharypartvaloe ils Daal : 


End; 
Writeln: ;Writeln; 


Writeln(’The Observer characteristic polynomi 
coefficints in ascending powers of 


Writeln; 
for,i:=1 to pedo 


Be 
~ Write(coef [i]; :10 


nd: Wr ite a 
B25: i KEYRERDCKEY, KEYOLD , NOT ERASED );ClrScr; 


Ome, . 1 


3 


ye; 


Be 
eae 1: 1 to 3@ do 


Be 
maces :=@.0; 


Eni 
AGA fees 1 to r=do 
a lest 
Piette: 
ee i be a Go Yr de 
2 
an iL? tour dae 
egin 
gt? ed Q.@: 
E oe 
F{(i,1] := -COEF[r rp ae 
ie er so O 233 
Eidos ged | 
28: nd 5 
Ss aoe to 2@ do 
2 
eH lis4:2 
T let <6. QO; 
size * r3;3 
ae = 1 to nr do 
egin 
BE eon 
nd; 
Mrep <= 72rbpi: 
Nrn t= nr +Size; 
ee i += 1 to size do 
2 
A Gata(nr+i] := desired feedback[i]; 
nd 
for 4 [= Tce  raae 
egin- 
fi:= size*(i-1); 


for <- 1 to r do 


Begin 
jj:= size * (l- 
Ore 


4 


k:= 1 to La do 
oe at 
PHI[iitk,Jj+K] s= -F[i,l]; 
na; 


End; 
End; 
for iie= 1 to r do 
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FILE: LUENBERG. PAS Program Listing 


Posen 
tie * size; 
tom | to size do 
"Bor 
or k: 1 to size do 
Pegs8 Ci 41 ine] := PHI[Li+l,i+k]+ A1A[k,1]; 
Idielele 
End > 
Or no wie Goer cdo 
Boas 7 
= size * (ii-1); 
Roe ae = 1 to size do 
See 
HI{nr+1,i+1l] := H[iil]; 
End 3 
Bnd: 
for a 1 to size do 
See ee 
on or l GO ne do 
Se 
AB aret neti) oC Pil Stale 
End; 
End; 
wen 2:= nr +no; 
for ifs= | to r do 
Begin 
i:= size * (ii- i )i 
t:= nrm + no -1); 
fOr es ice ne ae 
ae 
or 1 to size do 
oan 
Bi cats, t+k] := -C[k,s]: 
End 
End > 
rnd: 
mm:= r* (size+no) + no; 
Boxuse 


feeecolor(white): 
linear _equation( PHI,NRN,MM,BETA,X,K,U); 


Vom tite | to r do 
Begin 
i= size + (ii-1); 
AS[iil aos 
oe On {= al eace..S1Ze7do 
2 
id etP iy :sagliil +E[o] *X[ito] 
n 
End; 
MWe ioe Nee | 5 
Clroctmmniteln;Writeln;textcoLlor( en? 
Writeln(’The F Matrix is : Se Write ln; 
“BOI: = | tO wr do 
aad 
ee: = iO cr «a0 
egin 
Wied teC” ~Pli so ert ); 


Ae eee 


En 
EYBEAD(K is KEYOLD, ,NOT ERASED 
textcolor(yellow) ;Writéln(’Th 
Writeln; — 

for ii: 17 to Fr do 


Dy Clrecr-: ;Writeln; 
he Gi Matrix is : 
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FILE: LUENBERG. PAS Program Listing Page 5 
Begin 


i:= no tals + nrm; 
ee o— to no ds 
S 
parcel * , X Lessee) 
End;Writeln; 
End:writ In;wr iteln; 
Writeln ‘The G2 Matrix is : ’);Writeln; 
oa a or do 
2 
fritein(: ieee 1) 


En 

KEYREAD( KEY, KEYOILD,NOT ERASED) ; 

CirScr;textcolor yellow ;Write din: 

Wrance daa a output feedback coeffi ients are 
Ascending powers of S ; >’ )s;Writeln; 

for o:= nri to nrm do 


Begin 
Write(? 17 Ol amiDE 
Bnd;Wri eln:writeln; 
Writeln(’The compensator feedback co encore NUS are 
eerie ene of S ) 
a iWove al 6 = o rT 
Eee an 
aa een el 1) lhe es 
EVREAD(KEY, KBEYOLD,NOT _ERASED ); 
Repeat 
printer;textcolor (ye LODE SOttOxy (Sem >) 
te a BERG aa 
Zoinery | | 25):write(’ ye 
otoxy 49,17); 
fead(kbd,ch); 
ae Ch=’P’) or (ch=’p’) or (ch=’F” ) opm@G@eh—aie ) einen 
egin 
if cee) or (ch=’f’) then 
ezgin 
Zotoxy (45 Vea ;Textcolor(red); 
writet PRINTING......... >); 
Boa tee »>luenberg.RES’ );3 
2 Rewrite ist ae 
nN e 
a (ch=’P’) or (ch=’p”’) then 
Begin 
gzotoxy(45 Tepe o oO noes 
Wrdste ( ) Pea Tene | ee >): 
pee ae ‘LST: ); 
Be list); 
na; 
Writeln( list, ’LUENBERGER OBSE VER RESULT ’ ); 
or i:=1 to 2 do writeln(list); 
Writeln(list,’The plant matrix A is : ’); 
Writeln TA Scr: 
or i:=1 to size do 
Se aee 
ee | to SEZeRge 
egin 
Sanit Gin AA i, Lee ees 
End ;Write}n list): 
End; Writvein list); 
Writeln(list,’The input matrix B iam’) | 
Writeln list); 
Or =1 to size do 
Begin 


Se i= |) SO, eee 
TSG eC Mike Slee | ee 
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FILE: LUENBERG. PAS 


Program Listing 


End; bein(iigt)i 


Writeln ist 
Writeln list); 
TOT i:= 
Begin 

for 


Bnd ERED 


End;3Wri 
Writeln 


eln 
eS is 


tonne. = | 
Begin 
for 1: 
Bnd;Wri 


List, 
rest, 
to 


Writeln 
mri tein 
wor 1: = 
Begin 


Hee iist, 


Bnd;Writeln( 
Writeln eb 
polynomial co 


ee 
mor i 
Begin 


End; Meettcintiia 


writein fee 
Home 1? <6 ES 
Besin 

hroOree 2 = | 


weigoia( Tis 


End; eng 
Writeln 
£Or ee 
Begin 
its 
for oS 


ae 


End:Writ 
Writeln eS 


fi Qed s =n | 
Bnd;Wwrit 
Writeln 


tom ro = ell | 


Beg 


Bnd;Wri 
Writeln 


Wetted lest a: 


list 


Loree = 1° CO Fr 


Begin 


st 2 
to no do 


the’ des] Doe eea 
are 
to size HG 
* Eo: | 
= 

gin Oils 


eln 


ist) § 
Bnd: inf iis list 


>The observer nen 
ee PART 


al 


LO 1p do 


(11s ty: 


>The Gl 
to r do 


output Matrix C is 


to size do 


eee 
Pia(iie 
End; Banal iat): 


Bie tiaras) 2 


ees 
t)} ; 


Writeln 


do 


eee 


aa eee 
lue J 


>, coef eee 
writein(lis ))s 
F Matrix is : ) 


too Yr do 


Piette 11s 
rie boi Tig 


ree © ised) pes 


Matrix is : 


no 1 te" + nrm; 
to no do 


oan 
rite(lis 
End; be aoe 


stHe G2evakrix is : 
a to r do 
= 
firftein( 1 ist 
n ist 


Ross A): les 


5 ise Est IS 1 eee 


regis e output feedback 
are ;: sWriteln 
‘Eb Ouelie in Hee 


)3 


lise); pee 8 eee 
>The SC 
coefficients are 2 


ack 
list 


a 
i 
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27 )5 


Ogg cones 


,desired feedback[i]: ye 


lues are : oe 
MAGINARY PART? ); 


5104) “ , 
):; Writeln(list); 


Observer Characteristic 
cints in ascending powers of S’); 


sWriteln(list);: 


>)Y:Writeln(list); 


>)s;Writeln(list); 


oefficients 


dest 


eedback 
sWriteln(list); 


FILE: LUBENBERG. PAS Program Listing 


Write(list,’ ee ele ee 
hnd- 
mem 1: Ge 5 doewriteln( liste 
Close( list 


Une Mm in | Oe ; 
Assian( vibites ova dém ); 
s Bese See SvsFile); 
n 
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Ut-mod@2.INC 
Ut-mod@3.inc 


I eaoumenul tne? 


Ut-modge - INC | { I/O procedures) 


I Boxuser.inc 
label 2;:label 3: 


Const 
Xarray : string{14] =’TIME INTERVALS’ ; 
var 
GTINY : array [1..8@] of real; 
GTN searwayoll..10,1..60] of real; 
Pole ie D>, D4,Fi,o,zanmma cary tse 
D2,D1,GT Sary3s; 
Pee), ntberm,kk,code pe leiaece ceioe. 
Wawise ymin, Yr, denominator ,negatift,si,result :real; 
rapharray,grapharray! splotarray; 
eee aps, dul :boolean; 
11S tescG; 
ans -enar: 


{G1 Optimal .inc} 


ec ore PrintGraphData; 
this procedure dumps optimal result data to printer} 


Begin 
eaveGraphic;Clirscr tee on el Owe 
Center(’*** PROGAM OUTPUT OPTIONS ***'>1,10,80); 
TextColor(green); 
msg(’Press <P> Print results to the printer ’,1,12); 
msg(’ <F> List results to file name 
TOPTRMAL Rito. On the current Gi inv eel!) > 
msg(’ <Q> Owit ye aly: 
repeat 
ea kbd,ch ) 
If (ch = °F’) or Vc = Be} or (ch = ’p’) 
Siete =F ) vunen 
begin 
meeech = ~F*) Gr (ch = "Fr" ) then 
begin 


soonest, Optimal, Rus’ ); 
Rewrite Teco 
en 


else 
peLZrn 

eset e wy tee ioelcee)i 

rewrite(list); 
end; 
Write Ete ee 
write(list); 
writein(list,’OPTIMAL CONTROL RESULT ' ); 
writeln list)s 
wielbe list,’ The ose of the system is:’); 
write n(iist Size:2); 
write(l sy, Dubai number of time intervals is:’); 
write n(1ist Si: : 
Wolcowmse, Ihe scaler R is:’); 
write alee ee crs Ge 


1D 


FIR “OFT IMAL. Ras PRogramyLisuins Page 2 


write l ist 

writeln(list 

writeln(list : 

ae list,’The A matrix is:’ );writelme@rc F 
zie 1 to size do 


The arp ie internvalesc wee 


begin 5 
to size do 
Hee ne 
git cai SAVALL. J Joe 
end;writel (ist): 
end: writeln ist) 
writeln Liste. B matrix is:’):writeln(list); 
or . ln ES Sime do 
eee 
: 1 "Osman do 
egin 
Len atte ‘el 34 | ile 
end;writel (Hey) 


end; writeln Hee! 
writeln(list,’The Q matrix is:’);writeln(list); 
ora := 1 to size do 
pene 
or j:= 1 Ptem@emze do 
begin. . 
write( list.) .’, O(a aie: 
end;writel (list); 
end; wr teint iSite) 
writeln last. ae FI matrix is:’);writeln(list); 
for 1s= | tO @siZemee 
ea 
Or j:= 1 tO saze do 
begin | : 
write(list,’ . FL[ Pyaar 
end;writel (list); 
end; wr teint LS) ; 
writein(Tist 'The GAMMA matrixis:’); 
writeln iistce 
Pon t= | tO Sze de 
een 
or j:= 1 to ni do 
begin 
write(list,’  7,GAMMA[1 laa: il: 
end;writel (ist)5’ 
end; writeln( gS 1 
writeln(list,’MINIMIZATION OVER ALL STAGES ’ ); 
write]n( list); 
write(list,’N (stages)’); 
TOR le tO do 
write(list S GAIN ee Pare 
writeln(list); 
yrite(t oa —---------- Pa 
=i Oe aaa 
eal e(list,’ ----------- oe 
Witt eer list); 
for j:= 1- to Cages 
begin 
write(list,’ eee oe 
for l:=1 to i do 
SEE (li , hA seals eo) 
write(lis , era rra : 
avid: wasieenn (tele aie a 
end ; 
nd ; 


swapscreen; 
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close(list); 
ene: 


begin 
Ei? scr ; fer ena besten or 
writeln Design or Optimal Control 
procedure ***’); 
wr ited r( yellow); 
writel a en 7 er re ee eee ’ 
ot oxy ( ,25);InvVideo(’Press <ESC> to change it!, 
pe your nput with <ENTER> key’ 5; 
here Go tea 
nae Gane aqumber of, time seat ae for SUM 
dure 
HOR Ne . °So° - 65 4,6,true,F1,F10 
ary EL Nee ti,code); 
se hat is your sample interval? . , Laon 
ee »°35.6,6,true,F1,F1Q@);° 
(answer ee code); 
(>What is the value ons aloe a Qo See 
TaBytC ne! 73. Qs ,6,true,F1,F10); 
answer ,r,code 
Meet (°For the e278 ax. ee a NeCcese 
mumction do you w ae 


TextColor(lightma enta); 
=terminal+fue +trajectory O 


Msg( ’COstT rE 
pee eeadeCtory G0. Selene 9). 
ee ee ie ue or 
COST=termin <1) 5 4elbee) 
mee? 2 1, 13 3)3 ; text Sener et Ow 
msg(’Where aS; textcolor lightmagenta);. _ 
ms ; 9 ! 9 , 
mse Terminale= i/2 X (N) Q X(N) rr Go Lome 
msg(’ 31 hie) 
msg(’ N-1 T ale t ds 
msg(’ Trajectory = Woe x7 Ck). Q X(k) | a 04 ° 
msg’ = 1,20 ; 
msZg q 2 lege) > 
ee Fuel = 1/2 x U (x) RU (k) 3.1753} 
ms Z ue = ; 
msZ = ee.) s 
Imp ee O65 510.2 true, F1,F10); 
va enewer nterm, code sclrscr; 
yriteln( enter the element of Q matrix: ’); 
Weis =! to size do 
eae . 
Sees =1 to size do 
Pmt 712959: 
a ¢=@. 
write 'ats) write mle ees vee 7 Jewrite(j )+ 
write(’)= );read 
end;swriteln; 
end; 
Repeat 
ClrScr; Writeln 
Writeln(’The Q iene is +? )eswriteln; 
for = 7-1 GO sSsize do 
aoa 
to size do 
Bee ae 


mrce«: °°? ,, O[i,j)]211); 
End; welt J 
lind * riteln; 
Write(’Do you want t $7 FPR ae element of 
Read( Ba iB trix'2 ot ¥ 
ea ns); 
ie lilows user to change entered data ) 


Ie 
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if (Ans  =’Y’ ) ome cus — 2) one 

Begin 
write(’Input the row to change : ’); readlin(i); 
write(’Input the column to change : ae 
readin i Bel 
write -J>’ d= *Dyreadin(resulion 
Ori) sresult} 

hn: 


Until Ans in [. ay 
textcolor (whi e 
eS 
I_and * GAMMA(SI, FI,GAMMA); 

4. sie procedure to calculate fi and 
gamma matrices } 
TextCow hpet bow) 3 Clescr > 
yritein(? matrix is : ’); 

for = to size do 


be 
hae j:= to size do 


Seta yt ele): 
end; Gite line 
end; wri eln; writeln; 
writeln ‘The gamma matrix is: ’); 
for a to size do 


begin . | 
_ j:=1 to ni do 
2 alk 
gin. ,~GAMMA[i,j]:11); 
end; cue ane 
end; swriteln; *writeln- 
keyread(key,keyold,not_ erased); 
Boxuser ; 
form = te - si zero 


begl 
BI Biya [=O 0. 
a: -=0.0:; 
For jist to size do 
e 
D3 est clecemi une: 
D4(i,)]41:=0,03 
PILis3 =Q(i,j]; 
end; 
end; 
'= 0.0; ymax “8,0 symin =i es 
or - O O 
begin 
Genominator:=0.0 
(oe to size do 
2 
for. J =1 to size do 
Ss 
Bili]:=D1[i] + GAMMA[j,1] * P1[3,i]; 
end; 
end; 
for La =1 to size do 
ean Lt i d 
= o size do 


be 
SET: -=D2Ti] +eDI—~j) © Enea 
_denéminator : =denominator + Difi] * GAMMA[i,1]; 
denominator : =denominator+ R; 
negatif: 
for i:=1 =u Weds do 


be 
Gti}: = negatif * D2[i] / denominator; 


116 


FILE: OPTIMAL. PAS Program Listing Fase 5 
GIN [TKK] :=GT(I]; 
D1 7 : 
D2 aon ae 
end; 
Tor a =1 to size do 
een 
or j7-=1 to size do 


ou j]:=FI[i,j] + GaMmMa[i,1] * Gt[j]; 


a ae =1 to size do 


be 
for y2=| to size do 
e 
ab iL to size do 
= 
gin .. =DS5[,i1,j,).+ Psit[l,il “eel, ii: 
end; 
end; 
end; 
Bene f= 1) tO maze do 
= 
for jJ:=!1 to size do 
e 
gin aes to size do 


PBR: ” =D4i57,) +D5(i,1]) * 2sSrer 4 |; 


este nte m 43 @ then Oto 
P1 D4 GT * QT OOo a: 
Piped isgmeca eddy] fa eOPC4],*OlAd; e08 
GT +44 
52D ieee : 
end; 


enc, 
Pore =| CO Size do 


Seetn 
Sr js=') tO size do 


begi 
D3 i jules = CRO; 
end; 
end; 
end; 
mores =| tO size do 
For . 
obeys =1 to ti do 
Oe aany Jj:=GIN{ I : 
te ae i J44 then y:=GINy[ i 
else y:= 1.@e : 
Tae > Ymax ketee Ymax:=y3 
abate Cc v4 aoe : 
GrapharrayL: 2 Sm GS 
grapharray =) ya; 
end; 13? 1j:= y;3 
ymax: 1.2 * Ymax; 


imaaaeraDphnic; 
Semle stwindow( 1): 


gotoxy(4,4 Vedat 
ZOtOXY 4;5)swrite 
Zoroxy(4,6);write 
ZOtTOXY 7 


4, write 
zotoxy(3, 


write i: 


ZH>O 
oe 


wewewe we we 


FILE: OP@IMAL. PAS Program Listing 


See eee 19551 ,xarray ); 
Niceaxes(@,t1i,ymin, ymax NF 
Selectworld(worldndxglb 
Selectwindow(windown a) 5) 
Drawpolygon(grapharray, 1 Dee 2,0,0);3 


rewecc ae keypressed; 
quit:=fals 
repeat 
Graph | a CONTROL GAIN 
PLOT’ ,dumpgraph,quit); 


aad Bates then printgraphdata; 
id Glee el 
leavegraphic; 

end; 


Beectte(Svsriié a vs.COM’ ); 
Execute(SvsFile); 
en 
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mie POLE.PAS Program Listing Page 
program pole placement(input,output); 


SI ey Dede to sys). {comman type & variable definitions) 
of Ut-mod@1.inc 
SI Ut-mod@2.inc 
label 100; ; label 11@;label 12@;label ae label 140; 
label 15@: label 160;label 170;label 180;label 19@; 
label 200: meee Zo 3 
type 
ary6 = array {1..21J] of integer ; 
ary4 = array [1..11 of real; 
var 
AA, PIN, P1@ saryls; 
eee sary4; 
Coen DEN, , HA sary4; 
realpart, , imaginarypart real part, 
eaaoart > part,rea root imaginaryroot, 
realpart ,imaginarypar rt] Saryos; 
Miewiiieatl, |, | + J) »K Mize, 11, ,er , 
vertpos, horizpos, poscounter, code -integer ; 
gaint test sreal; 
input2 scohar 
exponent,strg ee enol: 
Change, factored poolea 
specification geringtsi 
-iputt ile 
Pe eeeder maize one integer; 
List : text; 
a Ut-mod@3.inc}) 
I Pole.inc} 
I Polynonm. ae 
I Inverse.inc 
I Rootfind.in 
I Boxuser.inc 


begin { open LOop calculatien s } 
=e. user; Sere! Tee one: 
BHARSCTER ISTIC *BOtAET ON ee “sith. DEN 


aay. 
oa 
1 polynon. panes 
eliacr: extColor ( ean $ 
writeln *Denominator o Mics eas )) Seva 


> 


1 


vertpos: 
for i:=nn lomo 1 do 
begin 
= tia 
oscounter: =(j mod ae +1; 
orizpos:=poscounter*14; 
a poscoun er = 1 then vertpos:= vertpos+2; 
ao Sin then 
eoretsuets ap ges tt ,vertpos); 
wri 
eC panes. vertpos); str(i-1:2,exponent); 


msg(exponent,horizpos+1,vertpos—1 ); 
n 
else 
begin 
otoxY(horizpos- 190,vertpos);:write(DEN[i]:7:4); 
ae writeln; writeln;writeln;writeln; 


root _finder(size,den,realpart1,imaginaryparti1,one); 


ie 


Pies POLE SrAS Program Listing Page 2 


writec? The poles of the Y(s)/U(s) are to)? PART’); 
write a IMAGINARY PART ’ ); 
for i:=1 to size do 
begin : 
write > 
Weigel r alpar tail wilecege ted writ (ee +75 ie 
write nit tate tee ee are 45% 


end; 


keyread(key,keyold,not_erased);clrscr; 


tf OR waa to_size do 
P10fi, Sawer SS claiale 
for JJ: = 2 to size do 
ene 
Or, i2=1 ersa ze de 
begin 


bisti® 3]? SDEN nbd *§ ati, 1]; 


O Sila 
°F 12 oti ,iic= PL ODE a) 4A1 AL erg eae 


102 Lze oO 
il]:= Bats oat * C{1,j3] + Cee 
1 


en 
fo to size do 
be 


WBE 


3 penariy <> @.@ then goto 100; 


750 Textcolor(yellow) ; 

109 Texte Numerator o Y(s)/U(s) :’);3 
vertpos: 

for i:= m od ame Itdo 

begin 


m 
a gecaunteor :=( jj mode) +1;horizpos:=poscounter*14; 


if poscounter’ = 1 then vertpos:= vertpost2; 
if i<> 1 then 


al 
Sar X¥ (hor izpos— 10, VER EROS } irene (cetil: eas 
"ees »,horizpos,vertpos aoa 2,exponent ); 


msg( exponent ,horiZpos+1,verupos=1); 
n 
else 
begin 
otoxY(horizpos-10,vertpos); writeCec (4): ae: 


end: writeln;: writeln;swriteln:writeln; 
msize: == 1s 


root _finder(msize,CC,realroot,imaginaryroot,one); 
weite@’) zeros of the Y(s)/U(s) are: 


write ae PART’); 
a IMAGINARY PART ’); 


write 


for an to msize do 

begin 
write a) es 
write alroot [i |i wr rit Ge +3 ye 
write realroot [1]: 7:4 {1:7 a5 $ 


120 


Praise POLE.PAS Program Listing Page 3 
Enid ; 


keyread(key,keyold,not_ erased);clrscr; 


m:=m-1; 

clrser :textcolor(green); highvideo; 

msg equation’ 41,6) ed closed- loop characteristic 
msg(’ pees de BY ee or Coefficient (C) 


% 9 


eat read( kbd, ee 
a pap ute in v ee ee Jel 
inpu or ae Ff ) then 
Seain 
if Bee then 
a, alee to size do 
e 
Bren part(j]: ,filvarlexjt 423 
S56 Maney art 5 filvar 4+10]); 
en 
input an, 2 ae real part, 
i 120: imaginary part); 
ena? O 


if (input2=’C’ 2 or (input2=’c’) then 
clrscr;3;m:=sizetl; 

i change then 

fem j2=-m downto 1 do 


be 

Str( EL]: 10:2,Filvar[size+22-j]); 
end;umra aes 
input coef et ( POLES’ ,size,e); 


este, »E,real_part,imaginary_part,one); 
eirser > 
write('The Roots ,oL er ys" oS closed-loop 


haracteristic’ 

write nO? polynomial are: ’); 

write EAL’ PART? 

write “1 IMAGINARY PART ”’ 

for i:=1 to size do 

begin 
write _ 
write ear tli: sae Hee +3 >); 
writein(im ginary part ij 


end; 
Pee) reyold, not_erased);clrscr; 


Wee seer 1lt=!9to size do 


op j:=!' to size do 
eee a, 
ALi ,j)]:=0.0; 
ene; 
en 
i:=0 
160:1:=i+1; 
if ima inary partf{ 20 On th 
-=feadl par ta 7 -ZOto 1 
TAA i,i)]:=Yeal part[i 
> :=-imaginary Bea 113 
RA ee ence inary Brea ; 
al ATi i} :=real ec), 
170: Tif Ci- a ® then goto 169; 


CHARACTERISTIC EQUATION(AA,SIZE,E) ; 


“a6 


121 
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Lae -for i:=1 to siPZegdo 
egin 
ae ECLi] - DEN[i]; 


end; 

Los to size do 
egin 
CCC[i]:=<C[1,il; 

end; 


INVERSE _FIND_MATRIX(P10,CCC,SIZE,PIN,CCC,ER); 


ry) 
O 
rs 
ra 
Ul 
= 
ct 
O 
i) 
|! 
N 
O 
Q. 
0 


"Sei ) :=@. 0 
i | sa. 
Hen J =| tO sa Ze mae 
ail 
filil:= HH{Li] + PIN({j,i] * Hj]; 
er 
end; 
in| bO SiZevde 
eg 
een j:=1 to size do 


eR. j]:= A1ALi,j] - BCi,1] * BHO]; 
end: 
CHARACTERISTIC EQUATION(AA,SIZE,E) ; 
de CC{1]=0.® then 


egin 
eet s=1.0; gote Zig. 
Sse 
2 
gaint := BCI] ae Othe 
Ost sea hen’ Zaint <:=1 .@; 


textcolor TNC, 
[6reat-=1 tO Size do 


cefats 1: - HH[i] /gaini; 


14@:for i:=1 to size do 
begl “- 


atid =H[i {gaint ; 
oe i [size then reduceorder:= oouees oe ils 
clirscr;Writeln(’ TNomenaten of the Heq(s a na 
vertpos:=2;3 


for i:= size downto 1 do 
begin 
j:= size -i; 
poscounter: =(j mod 4) +1; ;horizpos:=poscounter*14; 
1g poscounter = 1 then vertpos: = vertposte; 
if i <> 1 then 
begin 


ot X¥ (Chor iz os-1@,vertpos);write(H he are 
eis ier ize VeRER Oss h ae e a exponent ); 


mescexponent hor test |) Vas 
n 
else 
begin 
Be oro ner 12 pean »vertpos);:write(H[i]:7:4); 


Sar writeln;: writeln; ;writeln; 

reduceorder:=size- 

root “finder (reduceorder, H,realpart, 
imag ginarypart, ,one 


writeln(’The roots of the Heq 


S ) are :’); 


Lied 


Miike POLE. PAS Progranr Listing Page 5 


oa tSt, REAL PART’ ); 
write 1 IMAGINARY PART ’); 
for i:=1 to reduceorder do 
begin 
write i 
write realpart [i]: eee ey Ge +3 >): 
7 er imaginarypart sae aS: 
n 
keyread(key, »keyold,not oes. clrscr; 
190:if H{n2] <> 9.0 then goto 209; 
n2:=n2-1; aoe 190; 
200:n1: =n2- 
Ber ecolor yeitow); OLOX (rere); 
writeln e feedback coef lear [ k ] are: ’): 
writeln; for i:=1 to size do 
Des in 
write(’ ’); tteipr ee esa): 
ends writeln; writ 
write(? ee gain. a 
writeln(gaini: )) PEt ein: 


a le ee not erased); 


Geexy( 1,25 eee ane 
gotoay( 15 ); ) 
eae bd,ch); 
If (ch=’P’)’or (ch=’p’) or (ch=’F’) or (ch=’f’ ) 
then Begin 
Mapeei— Tye or (ch='f?) then 
Begin 
gzotoxy( 45 pec Conor red); 
Gritet PRUNE MONG. 6... oe >); 
See ee Se: “ress 
print oe placement output } 
2 Rewrite (list ;{to file on the current drive} 
n a 
Ee (ch=’P?) Or en= > ) then 
Begin 
ZOtOXx: ee 1s oY * 
wet pele PRN ONG: ....58.. re 
eee St jou: 
print pole Pi acement result to the printer) 
Rewrite(list); 


Writeln list) ;Writeln list 
Writeln( list The Plant ma 
Wee oe ln list); 

ron = <= 1 to size do 


Be 
For 5 to size do 
2 
ia nis We eae jJ:11); 


Ene ee ern 
End: bein( {ist n(tist) ‘Writeln(list); 


En 
weaceln list POL istye RESULT i 
rix Ais : ’); 


Writeln(list,’The Input matrix Bis :’); 
eee lis ys 
2= | to size. do 
a 
fi to ni do 
RB aig 


»BLi, aiieliusualiell Jes 
mid; writein( 13 
End:Writeln (List) oT st): 


ras 
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wi paen ( Tee “re Output Matrix © vou, 


writeln(list); 
Per z <= | t0 Mewae 
pean j 
i -=1 tO SilzZende 
2 
B10 ois ,CLi, 5 tale 


end; era 
end;Writeln a(list) AWiaieultrt (leva cate 


write(list,’Denominator of ¥(s)/U¢sQ. —’); 
write aftise > Descending powers o 7)? 
Wr tiem, Lic y; 
for i:=nn downto 1 do 
begin 
aoe etaeee DENT] 734 
end:writeln ligt) writela(iis \s 
writeln list,’The poles_of the Cee are:’); 
Wiel te (team REAL PART? ) ; 
write a(iise, IMAGINARY PART ’); 
or is=1 Geo size do 
begin 
write(list,’ ae 
write jist,realparti[iJ]: 7:4); 
write(list,’ Bl 
write nti Sto aginarypar Wa ees 
end;write AC TUS write lis +4 
write(1 st,’ Numerator of Y(s)/U(s) nos 
write aftise > Descending powers of gi De 
Wie to ered list); 
oe m+i downto 1 do 
egin 
write(lis = sais A ae 
end; wee ee lis t)swrd eln(list); 
writeln st,’The zeros of the Y(s)/U(s) are:’); 
write(list, REAL PART’ ); 
qriteiatiiaes IMAGINARY PART ’); 
for i:=1 te msizemde 
begin 
write(list, ‘pie 
write list, srealroot [i]: 7:4); 
write a ; 
write a( Ty st,i aginar otli1:7:4); 
end;write é list eS nilist) 


Teele Desired clos 


loop’ Characteristic 
po lynomial 


Se - Descending powers of S :’); 
writeln Lakes) 

for i:= size+i downto 1 do 

begin 


write(lis 
end: ce eS eae oe ee 


write(list,’The roots of desired closed-loop 


characteristic’ }; 

write n(list, > polynomial are: el 
write(list, EAL PART’); 
write atlise, IMAGINARY PART ’ ); 
for 13st to size de 
pez 

write(list,’ Ears 

write(list,real_part[i]:7: 24); 

write(list,’ +j i 

writeln Pa eee aginar ar cf3]: ee 
end;writeln i oem ;swriteln 
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Meme. POLE. PAS 


Write 
write 


Or 2 
be 


end;wr 
Wile be 
write 
write 
Oke 
begin 


n( 
n 
iss 


in 


a 


ae! 


writeln(lis 


( 


gin : 

write(list 
eIn(l 

n list, 


Program Listing Page 7 


st,’Numerator of the Heq(s ) is ay 


mes Gee 
wr iteln( list ); 


size 


~~ 


Sst, 


il 


) 
’ 
re 


’ 
i 
’ 
t 
1 
) 


gin 
Welce( list.’ 
end:writeln Ti 


write 
write 


1 
n 
weitein( 


Ss 


t, [he gain 
Mist. Saint: /: 
list)?writeln 


Close(list ); 
End; 
Matit Ch in [°Q’,’q’ ]: 
Assign(SvsFile,’svs.COM’ ) 


ae 
Execute(Svs 
enc « 


-execute 
File); 


downto 1 do 


: mir fe 7 3 ye 
st)iwhiteln(iies 
The roots o coe 


duceorder 


J ? 
,imaginar ered 
Se a ClLat 
The fee back coe 


Oe ditlessse 


” 


) iti teint 
is 


gat ye 


ist); 
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Descending powers o 


LSU. 
LACS 


a 
S 


ya 


pieghad. gre 


IMAGINARY PART 
do 


=: 


{:7:4); 
Eenere {( k ] 


are :. ° 
“One =| to. Size cdo 


et eo 


e 
, 


SVS main program) 


FIRES YrPeDEF ~SyYo Program Listing Page 


HHH HHH HHH HH HH HHH HH HHH HHH HHH HH HHH HHH EHH HHH HHH HHH HH 


* TURBO GRAPHIX version 1.@0@A * 

: EEBe, Gor EME ESF BB ORES , 
opyri 

* BORLAND Internationa * 


(9 7H Fe TE HE HEH HEH TE HE HEHE HEE HE HEHE HEHEHE EEE IEE HEE HEE EE EE EH 


1 
=1 
MaxPlotGlb=2 
MaxBlocks =1 
Semin soLzea) 
Hee oe nel ae 


ewe 


8@ 

1@ 

O lean=true; 

SL St umccioec nen tome ae 


MaxbrrsGlb=7; 
Extension:String[4]=’.svs’; 


tyne wrkstring=string[StringSizeGlb] ; 
WorldtType=recor 
eae are 


een, 

WindowType=record 
X1,971,X2,y2: integer ; 
header: wrkstring;3 
drawn,top:boolean; 
size:integer ; 


en 3 
worlds=array Ci; -Maxworqscip} £ Wortealyrpe; 
windows=array {1,.MaxWindowsGlb] of_WindowType; 
PlotArray=array [1..MaxPlotGlb,1..2] of real; 
character=array Le ; 
CharArray=array [32.. 
PieType=record 

area:real; 

text:wrkstring; 


end; 
PieArray=array [1..Max poset ea of PieType; 
Oa Or a 


284 OPS Sree CT Sie 


BackgroundArray=array as, 
4 (| Of boolean ; 


Lime tyleArr yearray [ 

Aryls=Array oo 10, 1s Oa Oc ce: 
Ary2s=Array [1..10,1..19]j of integer; 
Ary3s=Array ..10] of real; 


Sstr4=String|4 J; 
StrS5=String : 
otr2@=String Q 2 
Sureosstring 2 ode 
Str4@=String| 40]; 
otr8@=Stringl&8@i; 
Str255=String[255]; 

var X1W1dGlb,X2W1dG1lb,Y1W1dG1lb,Y2W1dGlb, 
AxGlb AyGLb BxG1b, ByGlb:real ; 
X1RefG1lb,X2RefGlb, Y1RefGlb, Y2RefGlb:integer; 
a ee eee ey Oty tee ne ene aac 
WindowNdxGlb: integer ; 
X1G1b,X2G1b,Y1G1b,Y2Glb:integer:; 
XTextGlb,YTextGlb VSte Gee eee 
PieGlb,DirectModeGlb,ClippingGlb, 
AxisGlb,HatchGlb: boolean; 
MessageGlb,BrkGlb,HeaderGlb,TopGlb, 
GrafModeGlb: boolean; 
CntGlb,ColorGlb: byte; 
KrrCodeGlb:byte; 
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: 


FILE: 
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LineStyleArrayGlb:LineStyleArray; a 
hrueonrEnocs#array |§'O..MaxProcsGl | Givi mo Fring; 
bmarornrcCode ;ar ay Vee MaxerrsGlbil of ~“WrkString; 
Po@ip: strine i ] 

AspectGlb:real; 

GrafBase:integer ; 

Porld wor lds; 

window! : windows; 

CharSet:CharArray; 

eee 

AlA, eee LIS 5 
Len,Space,Drive:Str2; 

eee eu oTd: Tatezer: 

Not _erased,Finished, Exit, Inserton,F1,F10: Boolean; 


Ch:Char ; 

TemPlate,Answer, Previous_Answer :Str8@; 
SvsFile:File; 

P,Filvar:Array[1..35] of str40; {menu prompts) 
wor ldndsq@etib :integer ; 

escape,retriev,luen : boolean; 


@ 
9 


W247 
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Peet ae 2Os ae 
abel 1; {label decleration for goto statement )} 
var 

Code,I,Count ,NumberDecades,StartDecade, 


EndDecade_: inte oe 

Wf,Wo,Wi,Deltaw >: Real; 
PlotArrayl, PlotArray2, MagPhaseArray, 

pModa By rray; 

ZMagn, ZPhase, PMagn, PPhase, Phase : real; 
TempX,TempyY >: real; 
temp : char; 

GP me : boolean; 
A jj,kk1,m,1,cnpoles,sizezeros,one : intege Cy 
encoeff, ;numcoeff, cdencoeff >: ary4;3 


realpartpole, imag actor ,realpartzero 
1 Sep ere ,crealpartpole, cimagpartpole: Aa SP 
> ary si 


function ee sreal):real; 
Computes the base-10 logarithm of X) 


eee 
fea ee og:=0 else 
en koe #= nk) /Let10)s 

nee 


function EXpoue ey: X:real):real; 
computes Y raised to X power) 


~expon s= exp( X * (in({Y))); 


be 
fine DOXUSER; One :—i.- 
Characteristic equation(AlAa, size,Dencoeff ); 
for i:=1 to siZe 


be 

SST(1, size}]:=B[i,1]; 
end 
for. jj:s2 to size de 


be 
for c= GousiZze doe 


bezam 
eae jjt+i; 
PSIfa J]: -pencoer# [kk] * Bli, ae 
one ie to size do 
e 
SSt(i,j]:=PStli,j] +AVALi 11) ete oue iain 
end; 
end; 
end; 


for i:=1 to size do 


begin 
Nine oon ian Q; 
fer los 1 to size do 


be 
“ffamcoeft [1]: =Numcoeff[i] + PSI[j,i] * Cl1,j]; 
end 
end: 
for i:=1 to size do 
begin 
m:=sizet+i1i-i 
if huncocr etn <> @.0@ then goto 1; 


end 
eee s=m—-13 
ci ssene extColor lightblue); 
writeln *** Bode Plotting Parameters ***’ ); 
woe Lamare 1 lee 


Pies: BODEPLOT. INC Program Listing Page 2 
Writeln(? s=ss==s==ss=ss2seseeeeseeeeeeseezze==’); 
map im Onmelosede ce Loop Pilot?’ ,5;5); 

ae DU Gig. 2, a »F1,F190): 


sets flag 0 A 
temp := Copy answer 1 


(ages eee the open 
if not(temp in ‘ ok 8$ D 50) 


hen beep(35@, 1 
ee BEL on ipo Te plot 
Par aamed ene in, aOr Ie: 
= een Spenloop = true 


)° 
else OpenLoop := false; 
Msg(’ od is ee 


ie ce frequency to be 
example: 7 
Msg() ample: '.01 100 eto. x“ ,10,8)3 
pnp 7°50, 8: ee e, Fee 
eae Wo,code {Wo is ae first plotted freq) 


<a ae number of decades do you want 


P+8 tted? ’ S 
atc Ne ,51,10,2,true,F1, eee 
eee: NumberDecades, code 


root _finder(sizezeros, ae ,»realpartzero, 
imagpartzero one 

root finder(size, Dencoeff, srealpartpole, 
imagpartpole, one 


ain:= Numcoeff[sizezeros+1]; 
Hes i:=1 to sizezeros+1 do 


»°fumcoeff [i] : = Numcoeff[i]/gain; 


end 
boxuser; 
fer i:=1 to maxorder do eee ale = 0.0; 
mor L2=i1. to.S Zeros - 

enCoef cFte Tle = Nie oer [1] * gain; 
MoQine= | boot Ze + | do 

CDenCoe PFTi |] := CDenCoeff[i] + Dencoeff[i]; 
it. Vinee >» SizeZeros then CNPOLES:=SizZe 
NPoles should always be 


else CNPOLES:=SizeZeros; 
greater,but to be safecompute new denominator roots) 


reot ee seo CDenCoeff eee > 
CImagPartPole, one 


StartDecade := Boe (Wo)); 
Berm PR scale to plot } 
BEndDecade := Star Decade + NumberDecades; 
oe numbers. Also figure step) 
Wf := Wo *_Expon(19@ Number De ages 2.3 
DeltaW := Expon( (Wf/Wo),@ 12 
Wi := Wo; 
for Count := 1 to 81 do{do 81 iterations...arbitrary) 
Begin 


if OpenLoop ee bode numbers if Eien TOoRs 
an 


later if closed loop 
begin 


rao 


FILE: BODEPLOT.INC Program Listing Page 3 
ZMagn:=1.0; ZPhase:=0.@; PMagn:=1.90; PPhase:=0.9@; 


fe 1 to SizeZeros do 
” CCompute magn and phase of zeros for freq step} 


Ma n:=ZMagn * Saqrt(Sqr(Real tZero[I])+ 
= Sar(Wi-I a Par tZeroll 1593 
af RealPartZeroli ; 
7 Z Phase: Feiesetoi/ 2. @ eater 

egin 

Tf realpartzero[i] >» 0.0 then 

ZPhase:=ZPhase =- ; tan( (w wi- 
imap aaeeeeEe Ti 57 realpartzero[i])) 


else 
ZPhase:=ZPhase + arctan((wi- 
Z imagpartceroll \)7 (oneal eee 
end; 
end; 


“ee = to Size do 
Ee mnutee magn and phase of poles for freq step) 


°° Bitagn : tiMlagn * qe + 


i i ee Pate pageeryrols 


Phase: = BPhaseipi/2.o else 
begin 


fice realpartpoleli] > 0.0 then bet 
ase:= i rctan((wi- 
. i maepenee Olen 7s ee epolet ue 
else 
PPhase: =PPhase R 
- i maspar too lene Ga wart povelaenpe 
end; 
end; 
rifl plovting matn ie := Log(Wi ) 
{fill plotting mat with mag {tude values } 
PlotArray 1! (| Coeumt, 2 = 20@*Lo (Gains 
"7 vite ea Magn ) 
pL Oe ae ue 4: ;=Log a 84 5tte hase matrix) 
PlotArray2| Count, 2 s= (180/ x Ze nase patrix) 
{next stmt covers freq wrap -around } 
i Plotarray2}Count, 2 >» @ then 
PlotArray2Lcount,2]:=PlotArray2[count ,2]-360; 
Wi := Wi * DeltawW; {increment freq step} 
end 
else 
{perform same steps as above if closed loop requested) 
be 
Pia ciie =1.0;ZPhase:=0.0; PMagn:=1.0;PPhase:=0.@; 
for i := 1 to SizeZeros do 


be 
een’ =ZMagn * rede eee 1 tZero[I])+ 
Sar(Wi-Ima Par tZerof 3): 
tf RealPartZerol 1 + 
7 Phase: 7 ohosetpi/2. 3 wee 
egin 
e5n Realpartzero[i] >» ®.@ then 
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ZPhase:=ZPhase 


- Qi_+ar 
; imagpartzerolil])/¢ 
se 
ZPhase:=ZPhase + ar 
me paTevenord TiC 
end; 
enld, 
for i := 1 to CNpoles do 


CRe 


begin 
EMeene = Pian Pod r God Ee 


. i 
i oneal factiotereye d3 


_PPhase:=PPhase+pi 
begin 

polelil > 0.0 

1 

11)/¢ 


if crealpart 
PPhase:=PPhase 
EL HS 


Cimagpartpole 


else 
PPhase:=PPhase +a 
Ccimagpartpole 


end; 
end; 


fotarray elCount, 1 ] Log(Wi 
1 PoweEe matrix._with magni 
is Array1tCount,2] ¢= 20*Lo 
pila (Count, 1] :<Log(wit; 
Plotwirray2 (Count ,2] 
t stmt 
lag Plotarray2}Count, 2 
PlotArray2 
Wi * DeltawW; 


P 
(eal 
P 


(180/p 
overs f 


Ot 
t= PLPOvA 


{ne 
count,2 

Wi 
end; 


end; 

PlotBode(StartDecade 
PrepaAarray |, 

{bodeplot 


PlotArray2,0Op 


end; 


lea 


Program oisting 


Maga 


EndDecade ,NumberDe 


Page 4 


@tant (vw 


-rea partzero[i])) 


Sener ol Loe 


1 


Pie ee 


t 


then 


else 


cen Ey 
gegen Gwe 
-crealpartpole[i])) 
wi- 
Oe pan teonea |) ): 


ude values) 
Gain * 

/ Pia n)); | 

1 phase matrix) 

i)*( ZPhase-PPhase); 
req wrap-around} 
en 
rray2[count ,2]-360; 


ades, 
SnLoopie 


FILE: PLOTBODE.INC Program Listing Page 1 


procedure PlotBode(StartDecade Beer 
Number Decades: Integ 
PlotArrayl Plotar ay? PioetArray; 
OpenLoop: Boolcare 


COnSt 
MagnArray: array | beh Od 
char uve A Ge NG a Tt? 5." Uae 
B: pid? ?B? ys 
PhasArray: arrayl1, 13] 
char 


(2 ee anit Ss! 'B’, Gl cs 
FreqArray: tries = : FREQUENCY i ae. 
VG Teele st ee sinteger ; 

ch : Ciiames 

roe 
Delta :real 
MagLabel : string : 
PhsLabel : a : 
DecLabel : string! 3]; 
Tithe, 
Title2 : string[80]; 
oem ; Boolean; 

; realy 
quit : Boolean; 
risG $$ text. 


eee Log(X:real):real; 


Be 
eee nCk)/LH(10)3 
End $ 


function Expon(Y,X:real):real; 
iconsure= Y’ raised to X power) 


Be 
expon := exp( X * (1n(Y))); 
Procedure PrintGraphData; 
prints numbers to a file or printer} 


Begin 
fcaveGraphic Glrecer 
repea 


oe r(white O10 
writel | se bkocrtm Sth Ge bptions HEX 7) 
ZOtox (2 : 
write ite yaa ter output ae 
Textcol yellow); ZO oxy (20,14); 
writeln en ck our Pri me yes 
Textcol (whit gotoxy (33, 15); 
writel 2 <i> fee to File name aa) 
Zotox ¢ o<4b)y 
write : On the current drive es 
gotoxy al las eeee 
writelin(’<Q> Quit Oe 
gotoxy(42,15);textcolor(yellow);write(’"BODE. Se 
otoxy(28,17);3 
read eba < on); 
=? or (ch = ’f’) or (chm) P’ )Vor 
oe = °pD” then 
begin 
if (ch = ’F’) or (eh = °># )Sinen 
roxy (24.15) aeteolor cna 
otox stextcolor(re 
Grite Vee ine ine .... ee 


Pier: PLOTBODE.INC Program Listing Page 2 
assign(list yBodeee Issehes Pe 
List) 


rewrite 
end 
else 
begin 
ZOtOX: (24 13 3), textcolor(red); 
Write( ’PRINTING........... =) 


dceien ltstGe nol: 2 is 
rewrite list); 


end; 

Titlel:=(’ w (rad) Gain (db) 
Phase (de yrs 

nities sac Phase (dea) 9 ------------- eis 

weiprein( list.” BODE PLOT RESULT ’); 


writeln(list,Titlel 
writeln(list,Title2 
writeln(l list): writein(list); 
Tor it= 1 to 81 do 

begin 


eet ees feisty? 


“= 


: on( 1, Q, Uae if Eats 
cence s , 
plotArrayi fi, 2 3: 2 ; 
Protarraye ree 
if i= 47 then 
begin 
ee lis tear. 298 
writeln(list);. 
vpe alee Iie ieee een 
writeln(list,Title2 
writeln(list):; EHC Lle or 
end; 
end; 
end; 
until ch in [’Q’,’q’]; 
PPGer Cie api. C$ 
when finished ee ee ZO back to graphics mode 
and display graph 
elobe(iist 
close(list); 
end 


Been 
i glal yey eeig is asl alley. 
DefineWindow 
DefineWindow 
DefineWindow 
Fy 


up windows for display} 
MaxGlb,YMaxGlb 
,XMaxG1b-5 , YMax ito eee 
ymax Ds 5,YMaxGlb-15 


Q 
Decade, oe BRE eAGe ses |: 
Decade, , EndDecade, —3 Q); 


3 


DefineWorld 

DefineWorld 

SelectWorld 

SelectWindow 
set eacwer our 
SelectWorld 733 
SelectWindow 

DrawBorder ; 


SetLineStyle(1); 
Poul =i. bo do {draw horizontal graph lines} 
StartDecade she855) 


EndDecade,- 0+ 
For J:=@ to NumberDecades-1 
ae vertical logarithmic graph lines} 


DrawLine 


Begin 


pS 
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Hor a 1 to 10Mde 
aoe 
elta:=StartDecade Me en + J); 
Drawline Delta,-60, De 
end; 
nd; es, 
Ror freee i: {y-axis titles) 
F I? do 
aee50 
rawText(5,55+6*I, Pee eee }; 
DrawText (630, 60+6* hasArray 1); 


Ges 
DrawText (250, 1 on 1,FreqArray);{x-axis a 
For oe scale label 


Be 
Ste 69- 20*I:3,Ma Label : 
Drawlext (12,1342 eT, 1); tlagLabel): 


Str(@ , PhsLabel ); 
DrawText(600,13+28*1 PhsLabel ); 
end; 
For I:=.@ to NumberDecades do 


{label the logarithmic scale) 


oe eer un Oe rtDecade )+1:3, De ee 
OER HERES ete 56°9 div Nu berDecades *1.. 
361 ,Begl abel 


DrawText(3@ aoa NunberDeeaneen *T, 


199;,. 142 
end; 
SetLineStyle Bhi 
SelectWindow( 2 Sole Uveghd Cr 
DrawPolygon( ofArray |, 1,0); 
plot the i ee eae 
SelectWorld( 
SelectWindow iF 
SetLineSty ay 2 
DrawPolyzont a ee awe 9 1,0); 
hase 
copyscreen; é (phas screen to memory) 
rere until cassie 
eines Sy 
repeat call Bon graph options menu) 


if OpenLoop t 
Graph Menu 7 Open Loop Bode Plot’ ,DumpGraph, quit ) 


else 
Graph Menu(’Closed Loop Bode’ »DumpGraph, quit); 
If DumpGFraph een PrintGraphData 
dump numbers if desired} 
lng ow. 
LeaveGrapnic; {leave graphics mode} 
en 
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{* This program draw line for menu box. *) 
procedure Dox; 
gh a sinteger ; 
e 
fiehv4 chr (218) je LaF aw upper 


52 
write(chr raw upper Lore See 
ior 4 + = dic {draw upper horizontal line 


; 
wri Been OeD) ; 
8 do 


begin 
gotoxy(1,i);write(chr(179)); {draw vertical lines) 


— .. i)swrite(chr(179)); 


gotoxy (1,2 ; 
Sr i := 
eae t chr “f 9588 2° 
deen ice 
TextCol (whi te); ot oxa2 0. ce 
wirei tel pean your selection 
gotoxy ( 0, 355 . owvideo; {make input promt } 
end; 


> 
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Procedure Fi_and_gamma(var 
var 


var 
label 1:3 


var 
A2,A3,A4,A5 


Program Listing 


Page 1 


T:sreal; 
aie aryis; 
gamma:aryis );3 


saryis; 
aes sinteger 
tést value,step real? 
ae Pee 
est value:=1.@0e-08 
step =i .0; 
for i:=1 to size do 
weet 
or j:=1 to size do 
ee 
Pia | 3 =O 2c. 
Baie | t= 1 eee 
A4(i,j1]:= AVAL: — 
CAA lee {7 [2 oOo) oe eel 
Sees = * Fig, 4 |; 
end: 
ena, 
1 Sher 1s=1 to size wde 
eee 
Hone to size do 
egi 
a A565 = (Ts ra ) * AA i ae 
Rd disks + 09h7 93 Ui ctepet.a) « 
at :=A step+1. 
(ste oe )) a 173) 
AS a :=A5[I,J] + T / (step+1.@)) * A3dCi,j];3 
end; 
end; 
for i:=1 to size do 
aoe m 
or j:=! GOwsize ide 
ea 
Ait Tee =O 
LOT igo tous 2 3 
AA) les Ast atte J) + ATALI, kl * Bete: 
end; 
end; 
step: =stept1.@; 
for i:s 1 or size do 
Ont. SoZ 
if sps(ASLE_ i7)°S >» (test_value * abs (FI[i,j])) 
then ZOto ’ 
for i:=1 to size do {initialize) 
fOr je=) CO. mi ade 
GAMMALi,3]:=0.90; 
for i=], to sazeude {calculate GAMMA matrix )} 
for j:=1 to ni do 
forwe=— | te size do 
5 GAMMA[Li,j ] “GAMMATA , ij] + ASieekc] * Bibles i: 
end; 
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Procedure Matrix _reduction(Var dumy _ Square: Reval 
Var n,m,rank: Integer ); 


Label 142;Label 145;Label ne Label 17@;Label 180; 
Label 162; Label 198;Label 200;Label 224;Label 226; 
Label 228;Label 234; 
VAR 
Romie t 10on Bana 2 Ary; 
19¢ Pat, dda eo k pu »~start, 
,imin, 4! hl : Integer; 
Seioare. value, temp See sum >: Real; 
2oeen 
Or els 2 = Lo nN “doe 
ee ee ‘TO. Mie cio 
ferion Eiiateiecii, ||| 12 dumgecquarec ida.) 4 ; 
compare value := 1.@0E-8;3 
aC f=1F5 
NMmin :;<=n — 1; 


fc nmin = © then goto 255; 
Motte s= | FO nmin do 


ee ; be 
or J, >= Waicatoam do 
=a 


—vilainer lo eke: 


aa 


( ion matrix[k,j]) >=compare value 
ma Coro 1423 Lk, JJ S = 


aS 
142:If kj = i then GoTo 145; 
Hewes i t= JJ to m do 


Be 
Renip value := uction Battie tec) 1 4) 
reduction “matrix i,j1]:=reduction Brera tied eles 


nyeauetion _matrix[kJ,j1] :=temp_value; 


145% temp value := reduction _matrix[i,jj]; 
For ate := jj] torm do 
reduction matrix[i,jk] := reduction_matrix[i,jk] 
/temp_valte; 


ek, ee Piicmeaoro. 1Sy'; 
162:for 1 := start to n do 


emp value := reduction m ae qa; 
If ~abs( reduction “matrix, 34 <= compare value 
then GoTo es 
Bemus = i) co om ; 
reduction er anise eget eee ayeee ene ete 141- 
~ temp _ value reduction Matrix : 


let Oe Bia Gs 

GoTo 200: 

hsOemiyy s=i1-—1 ; 
herald :=1 to imin do 


emp value := reduction m peyixiii. 3 ye 
J 


If abs Reguctien “matrix[ dis =compare value 
then GoTo 


Sf 
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For 111 (=3ig cer | dome 

reduction_ma Sa eee := 

reduction matrix|[li,l1lij—-reduction _matrix[i, ieee 
*temp “value; 


198 :Bnd; start := i + 13 

GoTo_162; 

20021f ij) = m™ then 2oto 255. 

JTC =.) Fis 
Fond 
For 5 = jj to m do 
Soe : 

Temp _ value := reduction eMatrixtn, gece; 

c 
1: Bean Feduction _matrix{n,jk]) <= compare value 
pee GoTo 
oS a = Jk to m i 
ene “Mmatrixin,j 1] *=neduecaen matrix[n, alae 
temp valué; 

GoTo 228; 
220° nd. : 
GoTo 235; 
ae ON If:= 1 to nmin do 
eee 

emp value := reduction m etre 


If abs( reduction ~matrixl dt xf jel; compare value 
then GoTo 2534; a 


On Se te 
eS eenOn See j1] s:=reduction matrix[1if, scl 
-temp_value 
reduction oi cueing jC 


Zio? End : 
255:Rank :=0; 
Forei <= 1. tomncde 
Begin 
um 3:= 0.0; 
For 4. := i) sro.meade 
aoe 
if abs (reduction _ matrix([i, 44)2. — Berea value 
then redu ag atrix f 
dumy _ square| — 5 Series uera. smatr til ti 4413 
- St T= sum > Aine (reduction matrix 
n 
= as sum >= compare value then rank := rank +1; 
n 
End; 


Procedure matrix _multiplication(VAR matrix,matrix1!, 
ae trixe: : SOLS 


VAR L,M,N eger ); 
var mult matrix!,result_matrix,mult matrix2e oeAryis; 
sJo1t : Integer; 
Be 
fe j:=1 to m do 
begin 
or 1: :=l “toe 1) do 
begin 
mul t_ matrixi{i,j] := matrixf{i,j]; 
end; 
Ror k: 2a, to ic 
oul t_matrik2 j,k) 2:4 «matrix, lies 


For i =1 to l do 
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Be 
ao Jest torn. do 
Besin 
result _ matrix[i, Wap = OO. 0; 
or 
result tngerixte Jg4: = Bea een te a + 
is mult—matrixTli,k] * mult matrix2 : 
nas; 
End; 


ear =: 1 to 1 do 


aoe do 
= P dette? ji]: = result matrix[i,j]; 
nd 

End; 
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FILE: 


proc 


INVERSE.INC Program Listing Page 1 


edure Inverse _find_matrix(VAR A:Aryls; 
var XDOT: ary4; 
var ORDER: integer; 
var AINV: ary1s; 
var X: ary4; 
var singular:integer); 


label S;label 6;label i2;:label 16;label 2@;label 51; 
var 
B2 caryis; 
comp ,temporary value :real; 
Werle, cee :integer; 
peste 
Pon i =| to order doe 
°° Bor 
OF pas to order do 
°° STN Mic: 
Ait ir? 5 9: 
ana 
oS i1:= 1 to- order de 


ens 
be 


Sey i SdaTH, 
r ee 1 to order do 


alee 
earn OOF 


k:=13 
6:if (abs (B2[k,i]) -abs(comp)) <= 0.0 then 2otc 5; 
CO ap: = 32) (eens 


5: sk:=k+1; 

if (f= ord Yr) <=_OGtnenecotouc: 
if B2tin,i}| = 0.0 then 2oto 51; 
1D pies ji ae then goto 
if (n-i — eee 

for m:= 


a to order do 
S 
fon porary. Vater ——be mine 
Batt my ‘=B2[n,m]; 

=temporar: value; 
mp rary value:= a ieee |e 
N tivatr: AINV[n,m 
NVLn,mj:= temporary value; 
org y.value: =Xf{ij; 
= rarv ava ue; 
LET SSRRRTaTY apes; 
rary va Gop oe fe il; 
:=1 to order do 


f 
O 
m: 
n 
phy tet mJ]: ST eee ae temporary value; 
1 el oa 
J 
n 


O'Rycet > P<p<ct 0 
OOO Ne ee 


rary valué; 
1:=| Go orderaade 


OF 
OOS 


Oto 


iio: 
Asie: - 8 394 oh af. ett as 
mporary yaar =B2 

r n:=1 to order 


14@ 
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begin 
fom pene ATM] 2] - temporary value * 


Sora nj; : 

B2(j.n]:=B2(j,n temporary value * B2[i,n]; 
na; 

iO. engi; 


ena: 
Oto 20; 
fPosolmacular:=1 3 
20:end; 
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Procedure linear_equation(var AA:arye2; 
var nw,m: integer ; 
Var BBE,x tangy; 
var K: integer ; 
var U:ary2 


label ee 2:;label 3;label 4; label >: label (1s 
label 8i;label i2@;label 8;label 6 ;labél 1@0;label 1390: 
label 7; 
Var 
is,it,Kk,n,ki,41 17mm sinteger; 
al canes 
id saryos 
mle lado. Ww :real; 


Boe te {linear equation) 
-=hnw: 
ane =m+1 
for i= | GO.n ide 


Pesits mm] := BRUT 
to m 
for tis 54 -= AA i, als 


n-m) >= Ol then soto: i; 
n+ 


CoO m do 
ere _mm do 


i | Q@.Q; 


Ch ct 


—i 

oo TY 

° Hip. 

Huu Ore 
~ oi 


QI Dr-p Py °° rT} 


—b 
j- 00 


nou 
aonb 


_ to m do 


me 


Soy 
aay 
+ 


bo btdkh-rH- RO 

OO —ctN> 
oe Cfvwewe iT | 
lM 


:=k teem de 
gpa at [9 )-B1) <= @ then goto 3; 


WHR Soe 


OOF: 


ee 


sabs(ai(i,j]): 


DS ct hr- 


oe 


= @ then goto 4; 
to mm do 


ere SUN EIR Re 


“P27 AT De, 313 


— — |. HS I tye « yoo: fowe co 
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palit, k] :=c1; 
ou bag Pills | So Oe then foto 71; 
Pe ex [k,k] g 


k:=k-1 

for GO mM do 
isd J va =a ee 

Fad 


et is! —n “9 then go¥e oT Sine 
eota” 7 ar mm} yo ATLA, n]; 
Bo nor j:=kk to mm do 


woes 11k] ze At(K.d] / At(k,k]; 


5S 
e eat Cio] * a1 [e, 3]; 
ae te abs (A1 ba) - 3° aoc ape >= @ 
hen go 0° 
1 a Sac 
=. bid § 
End; 
ie te - m } >®@ ee goto 120; 
ee = heneeoto 6; 
kK: =n, 
ZOto ae 
Se2or 1;=kk ac 
ices | ie ae goto 120; 
week) 2 ok—1: 
Hor is:=1 to ki do 
Begin 
i:=k-is; 
Pe 1 es 
Lor oa LO! edo 
=a eore cis 
or 
itis re Veeeari 9 jee Abe, 2c | Al [ete |: 
End ; 
End 3 
Or a =1 to m do 
eee 
Ones ),:< tom ado 
Begin 
cfs ai an] @ then goto 1@; 
i bt t at gZoto 10; 
a nS. dk 
UlLi,is- Tal = DA tutes is]; 
10:End; 
ace 
k: 
ZOto “th; 
2O:Writelin: 
Writeln(’There are no equations’ );Delay(2000); 
130; Ende linear SG eeslea | 
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Procedure Polynomial of _roots(var n: ee 
var rr,ri:ary3s; 
var cfiar 4 : 

{This program calculates the coefficients of a 

polynomial from its roots 


label l;label 3; label 111s;label 222;label 2:3 
label 5: label 21 label 5@; 


var 
ick,nn,mp,i1,11,1,m, 0m7amp sinteger ; 
sumrea »prrealli, sumimag, prreal,primag :real; 
J [ar yor, 
Begin 
n+1 3; 
eu laae =1.0; 
or m:= O nade 
Begin 
Sumreal:=90.@; 
sumimag:=0.@; 
Tees 
Zot ; 
leo aoa 
24 l=~m) >@ then gZoto_5@; 
if (l-m) = @ then goto 5; 
mm:=m-1 ; 
LOR i:=1 to mm do 
Begin 
Tidal oe tacos 
naa: 


5: prrea =). (als 
prreall:=1.0; 
primag:= 


for i:=1 to m do 
Begin 

Pees ice ee 

c 

Seeeciss = panee | BRAC - [pe ee Ritt le: 
7 Bree prreal*RILick]+primag*RR 13 

n 
sumreal >= sSumreal+prreall; 
sumimag: = sumimag+primag; 


for i:=1 to m do 
Begin 


s=m—-i1+]; 
alter fot >»®@ then goto 5@;3 
Aa JLlj-n+m-1) <@ then goto 1; 
mae Sila m+1 3 
<=mp mod 2; 
P nim <> sy sao goto 111; 
Li mreal;goto 222; 
FE mp | :=-Sumreal; 
ae 


NO 


ee 

Twit a 7;5 

aeiteres is an error in polynomemal 
calculation from roots procedure’ ); 

eae 


smmp:= n ane Pike 
mmp <> then ae 


5 ee n _dounto 


Yb 


D3 


Or)- OO eas 


hen <= 
Q's 


to 
do 


WwW 
tj 
ry 
oy 
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\ Plot igqdurstess a Poeutine to draw the Nyquist plot 
rom the data generated in the Nyquist procedure. )} 


Procedure Plot _Nyquist(StartDecade, EndDecade, 
NumberDecades: Integer ; 
aay 2 Plotarray?, 
Plotarray2 
Mag Phase rray: PlotArray; 
BigcPice. OpenLoop: Boolean 


Var 


MiticnYint, 1,),n,code : TREO e SE 
Ymin, Ymax, Xmin, Xmax ; 
XLabel,YLabel : ptringls 44 
iis), Title? : String[80]; 
DumpGraph, GUEke peas 
w,XminL, Ymin Re 
GraphWidthx, GraphWidthY : Boas 
Xexponent, Yexponent intege 
XexpLabel , YexpLabel : string 5]; 
GraphArray : PlotArray; 
Lis 5 text; 


punect ion eee X:real):real; 
computes Y raised to X power) 


Exon ae Oe «(ty Y )))) 


Frocequre PrintGraphData; 
{dump data used to make graph to printer) 


Be 
feaveGraphic; see Scr s 
re 


Toxicol swage : otoxy(20,10): 
writel a 5); ° phocrafi boxe Ge opeténs eee 7); 
foe eRr 32 ow) (’<P> Printer output y 
Textco gotoxy (20, es 
writeln ck Your Pri a ”): 
eoeac os ge ae 20, 15); 
writeln(’<F> List to File nam ae 
Zotox ¢ Oro.) 
write on the current drive );3 
Zotox le Orly): . 
eee ae Quit elie 
otox 
Soe eRT 82 Fe} ow) write(’ "NYQUIST.RES"’ ) 
eosgnniacan{)> 
rea c 
ist =e :} Grecche =f )) OrwCeh = *P*) or 
_ eh. = 4p" then 
egin 
rf (ch = ’F’) or (ch = ’f’) then 
egin 
SOtOx: (24 NENG TCOTOR (red): 
write(’PRINTING..... >); 
aon list, Nyquist -RES' ); 
rewrite(list); 
end 
ec 
be 


&1 
es an stextcolor(red); 
tee on athe 


ae csom( dist Ins 2 ls 
rewrite(list); 
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PLOTNYQS.INC Program Lis@ing Page 2 
end; 


Titlel:=(’ w (rad) Magnitude 
Phase (a eitare YrProet on 
Title2:at. —------------------------------ on; 
writein( Soe NYQUIST PLOT RESULT ); 
writeln ae ee te 
writeln(list,Ti Writein(list, Title2); 
writeln ite tyz vwritein(list toe 
Soe ae 1 do 
egin 
= := Fr pl 1]; 
Wi lige lm nC list ws 95, a 
Mag PhaseArray tea 1 1 ie. s 
MagPhaseArray!i,2):11:3,’ ; 
PlotArraylLi, 210 se 
Plotarray1[i,2 10:3); 
if i= then 
begin 
write ae toe 
write(ljist,ch rete): 
writeln( vst. favre F 
writeln(list,Title2 
oe list); writelin(list):; 
en 
end; 


end; 
aneetnl ch in [’Q’,’q’]; 
EnterGraphic; 


Swa. poset ii: 
ose(list); 
ond 
Begin {Plot N: ist} {prompt for window parameters} 
rf not(BigPiay then z S S 
begi 
PL% = ?>1511N@0503-010101’; 
P| 4 = '1512N@0504-010101?’; 
PL5S = 91513N00505-010101’;3 
P| 6 = '1514N00506-010101’;3 
Clrscr; RSAC NG bo SEL } 
writeln(’  *** NY UIST PL ING PARAMETERS ***? ); 
bexteo lon ee ° 
write n a ee yee 
Ha Ziyi dee, 


wr yet naw ay Textcolor (white) 
msg Nyaut aetetine ane nates for the 
Ss 
TextCo Yar(yellow); 
writeln;:writeln;: write n;writeln; writeln; 
writeln(’X-Minimun: : 
writeln( ’ X-Nascimum.)  ); 
writeln( * Y= itm 7) ; 
writeln( ’Y-Maximum: °’ );3 


Input Handler” N@3@6° » Escape ); 
writeln; write 
— Any /NI28 S to these parameters? 


Gio Does true, ee F1@ 
tP ncdageecia v5" or Me Cat ie the ); 
er 


(i lt “Escape): 
Va var at Xmin,code 
Va , eves Xmax,code 
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Paes ade emin: codes: 


Val( filvar[lL6],Ymax,code); 
end 
else 
begin 
Xmax:= 100; 
{set default values for "big picture" plot) 
Xmin:= -1@@; 
Ymax:= 100; 
Ymin:= -100; 
end; 
INITGRAPHIC; 
niceaxes(xmin,xmax,ymin,ymax, ee 
m:=1; 
for 1:=1 to 80 do 
fr) (ab (plotarray ii eo Xmax ) or 
(abs(p Otarrayl ae ) > yinax y then n:= n+1; 
fiw > tienen n:= n—| 


use 1 extra point beyond graph border) 


DrawPolygon(PlotArray!1,n,-89,0,1,0@); 
{draw graph on screen} 


for i:=1 to 80 do 
it? (Aabpstmlotarraye | 211) >» Xmax) o 
ae Galle arrayiti,2l) >» Ymax) then 
n:= n+1; 
ie <> (een ems = n= 1; 
Setlinestyl (i) 
Plo 


array2,n,-80,0,1 ,9);3 


DrawPolygon 
mepeavmutil Keypressed; . 
{Put option menu on screen} 
quit:= false; 
repeat 


if OpenLoop ee 
Graph Menu(’Open Loop NyquistPlot’, 
. DumpGrap Git) 


else 
Graph Menu(’Closed Loop Nyquist Plot’, 
. ee DumpGraph,quit); 
if DumpGraph then PrintGraphData; 
WeG 1 Gla. Ges 
LeaveGraphic; 

end ; 
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{Graph Menu prevides a window on screen and offers the 
user options to make a titie, prime weer... slag War 
the nus from the graph, or quit and return to the 
menu 


Procedure Graph Menu(TitleWindowName:STR25; 
var DumpGraphData,quit : boolean); 


var 
Line1, Line2, Line3 : string[40]: 


puOe cau’ Title brompr: 
be 
fextColor (white); 


Center Graph Trtle ***" 1 723eac0. 
PL1j:= °1010A@4001-010100’; 

PL2ejl:= °1012A04002-010100’; 

PL3jJ:= °1014AQ@4Q003-010100’; 
textcolor(: ef low ) 

ms2Z\ "Line aes 0); 

ms2g(’Line 2: ;,)jl2 ye 

mszg(” Line 3: rae, 


tempo Oren een 
msg(’Type your title for your graph.’ ,6,20); 


ee 


Linel:= copy(filvar »1,40)3 

Line2:= copy(filvar 71,40); 

Line3:= copy (rr lvasr 5 neet, : 
end; 


Bee ShowTitle 
makes Cake Te eee and writes tittle dowgbiec:: 


bee ta 
eee screen; 
ineStyle 
SET TeT 
DefineWwor1a( 
Se lLecuvertd ? 
DefineHeader 


setBackground 
setHeaderQn;D 
DrawTextw e 

7 


{puts header on box) 


DrawTextw 
DrawTextw 
SetBreakO 


repea 
Pees Gao eee 
case ord O 


Chhe - Yo UR WD 


Kea ae 
wew we W 


ite 
allow user to move title box anywhere on screen) 
: MoveVer ane true) : up arrow 
75 : MoveHor ataslniel F left arrow) 
77 : MoveHor 1, trued : right arrow 
oe : MoveVer , $rus} ; down arrow 
ena; 
Unwell or diene koe 
4 fréeze box and continue with <return> key) 
end; 
begin 
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DumpGraphDat 
selectscreen( i 
copyscreen; ): 
Save en and display menu box} 
DefineWindo ( 30); 
DefineWorl 
SelectWorl ¢ 
eee 
4 
7 
1 
1 
1 


SetHeader Deen ae 


leu ite) nae Dicer’) 


a menu opt ions } 
ake Title to _ the Graph’ ); 
Print Table of Numbers’): 


DrawTextw 


° sta Teac 
eee 
DrawlextwW 
Beau tox ew 
DrawTextw 
repeat 
Cpvioen; 
case ch of {interpret user input} 
wees Beg 
swapscreen; 
(redi plays s ae without menu box) 
har eopy( falas. 1) DEtMitiescO Drinter 
Beousch ese: 
Chee =? P? 
end; 
3 Ber in 


iSavegraphic: peed graphics eae 


used to Generate Graph 
Continue to the Program’ 


TiGlerromp es ; DECOM Gn nete F1t 
entergraphic; return to graphics mode } 
Swapscreen; ee back graph 
ShowTitle; (display title box on SCM 
copyscreen; save graph with title box 
G e 

engi 
"N’: beg 

DumpGr phData := True; 

{sets boolean fo cause numbers } 
to be printed 

ee := "Ne: 

end; 
“O° . 


i 
1. hen’ Quit 


in pee mi) IN 
else Quit : 


149 


FILE: 


procedure input —hgeromeds 


POLEeLNC 


Program Listing 


Factonms = thine 
imaginary _par 


ee 


Page 1 


Zeros or poles: str5; 


re var aa epart, 
ary s ) 


{Begin processing Factored form ieee ee routine } 


Var es 
ales 5) : integer; 
tes : real; 
begin 
PL11 <= °'9@905 
PL12 [ee BIOS 
PL13 := ?°Q@907 
PL14 =) 7250 7 
PL15 := %99@09 
PL16 [= S200 
PL17 s= 79911 
PL_18 $= 2 el 
PL19 s= °'9913 
PL 20 =o 2 See 
PL21 c= 'Q9 > 
PL22 c= eS ie 
PL23 .= OS len 
PL24 = eee Sale 
P{25 <= °9@919 
P{L26 se 22559 
PL27 t= *9O24 
PL28 = 25 
P1L29 ¢= °9923 
P| 3@ = "2525 
ClirScr; Tex 
gotoxy (1 24 

Tnvvide Pr 
Canuenne y % % 
HighVideo 


Input ***? 
write lim: Text Color (green 


if Zeros or 


222222222222 22222224 


Color(White); 


01011-9001901’; 
91012-000101’; 
01013-90001901’; 
01014-000101’; 
919015-000101'’; 
91016-900101’; 
01017-000101’; 
01018-000101’; 
019019-@00101’; 
019020-000101’; 
01021-9000101’; 
01922-000101’; 
919025-0090101’; 
01924-000101’; 
01925-000101’; 
01926-0001901’ ; 
019027-900101’; 
019028-000101’; 
019029-90001901’; 
0190350-90001901’; 


aga 


Sn dis: 


then 


{write screen titles) 


s <ESC> to change an entry’ 


és Ve 
Desired fet eae Polynomial 


Pole 
writ@in( )NUMERATOR Transfer Function 


input 


else 


ACTORED Form’ ) 


writeln(’ (ee equation 


O 
e 
writeln(’ 
writeln; 
end; 


nput 


cate writeln;writeln; 
fore}: =1 NFactors do 


CTORE 


= 
= 


Ss 


str( (NPactors*2+10):2,stme; 


specification 


Input a See cee 


fer j2:= 1 


Form’ ); 


{type prompt strings) 


eae 


concat(’N11’ ,s tiem: 


esc 


to NFactors do 


e); 
the input handler ) 


compute the zero values fro 


begi input bandler str 

val 1(f4 var |2*7j+9 ,test, erg 

tee = en Real Part a 
val conversion success 
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ng Filvar 


-=test: 
ful if code) 


FILE: POLE.INC Program Listing Fase 2 


val(filvar[2*j+10], ae ,code 
; ee Pee ae 
if code = @ then ene srror oth 


eld; 
end; {procedure Input factored} 


{Begin Bee SS tne Coefficient form Input-Internal 
procedure 


Procedure Input _Coeff(Zeros or Poles:Str5; 
Coeff: integer ; 
var Coeff: ary4); 


var 


es al is {counters} 
NCoeff_old : integer; noe old poly.order if 


changing order 
test: real; {holds "val" Results Untidevalidated 
begin 
P[21 ] := °'G@406N01021-000101’; 
pet auenst er descriptors for coeff} 

PL22 = '1806N01022-000101’; CT eee input mY 

PL23 = °>3206N01023-000101’; 

PL_24 = '4606N0@1024-000101’; 

PL25 = '9@408N01025-000101’; 

PL26 = '1808N@01026-@00101’; 

PlL27 = '3208N01027-0001@01’:; 

PL28 = '4608N01028-000101’; 

PL29 = °'@410N01029-000101’; 

P[ 30] = '1810N01030-000101’; 

M@eertt old:= NCoeft; 

lee TextColor(White); {print screen titles} 
gZotoxy (1 e 


a 
invvid 5 i 
OA : 1 
writeln( 


t 
); 
ress <BSC> to change an entry’); 

*** Desired characteristic 
Folynonial imput ***" ); 

TextColor(Green); 


a Ae ie sero Poles =—— FOnas sbhen 
writeln(’NUMERATOR Transfer Function 
Input -- COBFFICIENT Form’ 
else 
begin 
write(’CO Fe esas Bor ---’); 


Seana Goo ee eee): 
ibie igyenn Mybyesgl ae 
writeln( ’Highest degree coefficient 
MUST be 1. Ke 
end. 
Hizmvadeo ; 
itu NCoeff >» NCoeff_old then 
e 
oe ee =1 to NCoeff old - NCoeff do 
or i:=NCoeff Old + 1 downt i elie: 
Filvar Li+1 SS Var ine 
end 


if WiCeetf < NCoeff old then 


D1 
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begin 
ON aoe 1 sO pelcre olay N Cees ASS 
Or vies re NCce ff old_+ 
7 Piles i] := Fil eS Cee 
end; 


VertPos:=4; 
Cor: =NCoeff+1 downto 1 do 


begin 
>=NCoeff+1 - : 
osCounter := (3 mod 4) i i: 
HorizPos := PosCounter * 


If PosCounter = 1 then wet bos —— 


str(i-1:2 , Exponent 
msg 
end; 
end; 


str((20+NCoeff+1):2,strg); (sets u 
input 


= 
meet s +’,HorizPos VertPos); 


specification == coneatt N22 ssrneen, 


Input_handler(specification,escape); 


for em Oe em downto 1 do 


eg 
val(Filvar NCoeff+22- pals jest ee) 3 


if code = then Coeff 
end; 
end; 


1L2a2 


Exponent, HorizPos+1,VertPos-1); 


Page 3 


VertPos + 2; 
ape OS then{prompts for coeff input} 


Cae 
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procedure characteristic —equation(var ae aryis; 
var ,intes Tr; 
var GS: ary4); 


{This procedures computes the characteristic equation 


esas COeriTvecltenvswoy  UcInee cine Principlée—minor 
me 


label 1@0;label 20;:label 390; nate ace label 590; 

label 6@:label 15; label 70;label 8@:label 90; 

label 100;label ji:label 2:label 5; 

var 
B3,A1 caryus; 
integer _ vector HaryO ; 
D10 S. arieay |. te Ree of real; 


mm,ii,l,m,i,kk,nr,nc,k1 
counter ‘min, even, nn,k lel n1 m1 —irnLe Ser; 
temp value det, det correction, 

determinan mola, determinant,value_c2,value :real; 


begin 
nn:=n+1 ; 
ee =1 to nn do 
egi 
C2li]:=0.0; 
end; 
C2tnn]:=1.90; 
fOr mce=i to n do 
be in 
Toe, 1 s= | $ 
integer “vector[1]: 1; 
otha 


aerct ger | vented: | :stnteges vector[1]+1; 
ae aie r >» @ then Zot eam 
olin) ) ® then go 

mm:=m-1 ; 

fer i:= 1 to mm do 


begin 
1Tis=1+1; 
integer 'vector[ii]: =integer_vector[i]+1; 
en 
eye for i:=1 to m do 
begin 
Srakicc=-1 to m do 
begin 
nn : =integer_ vector ils 
s=int eer, ector|k 1; 
Pileieicie| <= nr; ne |; 
Sane 
end; 
ae 1s 
counter := 0; 
foe itvi:s=1| to M do 
vegan 
eae = 1 we Grtete 
egi 
eititi,ji]:= Belial i,j 14 ; 
end; 
end; 
fom 21i-= | to Mrdo 
eee ae 
me=1i11;3 
oO:if Ai(k1,iti] <> @.@ then goto 190; 
eee 1s 
if (ki1-M) <= @ then goto 390; 
Zoto 490; 


ke 


1 


Paige: 


POLYNOM. INC Program Listing Page 2 
fF (ili-k1) > @ then goto 40; 
if Ch lee ® then goto 790; 
Or ee: =1° to M do 
een 
e D values=Alia ii, smimd 5 
ATELII mim]:=A te m1m 
ae k1,m1m :=temp_ value; 
na, 
COUN TECr > =_COUM@er- I.: 
(Ori ies = 2 lee le; 
if i1 > Me thene sore 2o:; 
for mim:=ii to M do 
egin 
if Al([mim,i1i1)] >=90:0 thenecotem- 7. 
value:=A1{mimjili Ais Ailiig, iia: 
foro le: = ieee to M 
ea 
1[mim,n1]:= ee, ni] = Allilijnl]) “vader 
end; 
8@:End; 
Pals Haak & 


:=1.0; 
for ili:=1 to M do 


be 

et: =det * A1l[lili,ili]; 
en 
det correction: eee counter * ynGt.0)); 
determinant old: a6 correction * et; 
even:= counter mod 
ii even <> @ then Pole 60; 
ee aa := determinant pele s 

oto ; 

®:determinant:=-determinant old; 
ZOtO SO: _ 
40:determinant: =) Oe 


29:D10[k):sdeterminant; 
Or 12 Go mide 
begin 


Sailor. 
aTeety (aaseer _vector[1]- (n-m+l)) >» ® then goto 99; 


A (integer _vector[1]-(n-m+l1)) < ® then goto 1; 
en 


mi:=n-m+1; 
value c2: =exD m * iIn(1.@));3 


even:= m mod 
for i:=1 to k do 
begin 
if even = @ then 
begin 
value c2:=value_ c2; 
goto Ma; 
cf even <> @ then 
begin 
value c2:=~1.0 * vailtierueZ, 


ybaeeneleecee ae 21 oosae acer 
e 9 


ends Foto ne oe ; 
9@:writeln(’Error in characteristic equation’ ); 


100: 


end: 
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{ This procedure uses modified BARSTOW method to 
calculate the roots of the polynomial 


PROCEDURE root finder(var n:integer; 
i” var A:ary4; 
Var U,V:anyos; 
var ir:integer ); 
{ label decleration for the GOTO statement } 


ae eet oce 4;label 7;label 9;label 1@;label 13; 


abe 15;label 19;:label 20; label 23;:label 390; 
label 32;:label 33:;:label 34;:label 36;label 49; 
label 5@:label 52:label 53: label 70:label 72:;label 73; 
label 75:label 76:label 81:label 82:label 10@: 
Var 


meevy,1,nec,m,nl,np,),11 sinteger ; 
Priddis .e,Coalr,d,dap,pp:real ; 
Hwee @em array (1..21])] of reals: 


irev:=ir; {take given values} 
ne 2 " a 
oY i e1nCcado 
AEE}: f°aP 295 


. 


{imitiral 1 Zouaon, 


00 'rHOas 
QO Leesod 


moe 


P< Cp WIs,0'0 
Or-r-t ) ee co ce ce 
eek tt Il 


O 
b-ct 
ry 


<ctFhO DLO I-~ 0 


1) = @ then goto 100; 
then goto 7; 


co hee 
we & 


“Tm mp 


] 
<> @ then goto 9; 


Rect i Wt hect i 


OWBr We,0'0 ~2e IFPI 
OOe"s eo O ee ce oe CG 
Rivne 
HOS 
HQ 

nats 

PP 

N 


2. 


tom 
peaiad ye 

~=Hinlil: 
= eels 
ad 2s - 


Qu 


CeaOe tienes ouollo; 


ee 


8S 11 aan 5 


“NSM Uh YO oot 


I] ee 


S 


-@ then goto 19; 
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oo V]ec WO ee HS 
I] ee ctl 
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e tye 
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nco+1 =%.@ 
nD 3 =we— i 
20:for j:= 1 to 100@ do 
begin 
for.11:= i evemme do 
pe2zan 
i:=ynC—iaP- 
1g :=H(i] +R * Bli+1 : 
C lee = Bae + R * CLit+l]3 
it labsCElliVapibre) 22 omcmenn to 50 
Jie pag 4 Q te25 ZOCO Zor = 
eat ae 
oto 30; 
Beir:ar — Bll Weitee 
20@:for i1:= 1 emap do 
begin 
1 c-il; 
BLi = HLij - p * BLit1] - q * BLi+te2J; 
C = BLijJ - p * CLi+tl - q *CLIit2]; 
end; 
if H[2] < .®@ then goto 32; 
if (abs(BL2]/H[1])-e) >» ®.@ then goto 34; 
Af (abs(BL?1 (Hl 1 1)-e) <= 0.9 then goto 33; 
32:if (abs 2]/HL2])-e) > @.@ then goto 34; 
3p iit abs ( /H : -~e) <= @.@ then goto 70; 
[eben = = : 
ane cle * C[3] - cbar * C[4]; 
if d <> @.9 then goto 36; 
p:=p - 2,0; 
goto%4 Gao) 
6:p:= p+ (BI2] * Ci3) = Bhi] *2ela 7a. 
arte ee J wee i Sr Pf j er$43}aé 
49:end; 
e:=e * 10; 
BQtO 20; 
iC 2 ec — ile 
vfned:= ®. 
if irev >= © then goto 52; 
Ul[nc]:=1.@0/r; 
Sea Di OIE 
2:U[nc]:= : 
Soho. 16s eo nc ada 
H one BLit+1]; 
ee 4; 
Onc 22nc—e2 > 
if irev >= 6 then POLO Tes 
Bpizp/cast 2.0); 
oo 52 i ; 
>qQpD3= q; 
DOs ee 
13:3 a * — : 
phat iG Seacilid werk oto i: 
U estes DD; 
ULncj:=-pp;3 
V ee Se eee 
Vincj]:=-V[Enc+1]; 
aero 1 Ge 
S:1f pp <> @.0 thtenmegovue-e. 
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Urne+1):= -sqrt(f); 
So r5 ne+t] Be eee * { abs(ppe@e + saqrt(f)); 
Tego 
V Or. 
q ATS] Bre ne 24$ do 
100: eae me 


Toy 
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